* PiKtloru control^tngint^follc 

* D«scription: 

* Thig function 8«ts th« overr i descent ro I _(node to no over ride so that 

* th* engine follows the ecceleretor demand. 
* 

static void control engine foilower(void) 
{ 

idefine POSITIVf PEDAL TRANSITICM TIME 25 /* 250 MSEC */ 
•define M£GATIVE>EDaOranS1TI0n"tiMH 40 /• 400 MSEC V 

engine.status » ENGINE_FOLLOUER_MOOE; 

if <(acceleratorjpedal_position >« 5) && /* positive pedal transition */ 
(accelerator_pedal_position old <■ 4) && 
(low speed latch » FALSE))' 

< 

posit ive^pedal trans » TRUE; 

zero flywheel trq_time » POSITIVE PEDAL TRANSITION TIME; 
if (zerojlywheel.trq^timer >« NEGATIVE_PEDAL_TRANSITION_TIME) 
zero flywheel trq^timer » 0; 

else 
< 

if ((acceleratorj>edal_position <» 4) && /* negative pedal transition */ 
(accelerator_pedal_posi tion_old >= 5) && 
(low speed latch » FALSE))' 

zero_flywheel_trq_time MEGATIVE.PEDAL_TRANSITION_TIHE; 
zero flywheel trq_timer a O; 

> 

> 

if ((zero_f lywheel_trq_tiiner < zero_f lywheel_trq_titne) && 

(current gear > 1) &4 (current gear < 10) && (low speed latch " FALSE)) 
i ' 

engine control ^ TORQUE CONTROL; 

command.ETd « C_ETC1^0VERSPEED; 

desired"engine_pct_trq » needed ^rcent_for_zero_f ly**eel_trq; 

if (actual_engine _pct_trq < (needed j>ercent_for_zero_flywheel_trq ♦ 5)); 
zero flywheel trq_timer+-»'; 

else 

if ((positivejDedal trans » TRUE) && (low speed latch FALSE)) 
< 

po3itivej)edal_trans ■ FALSE; 

engine^comaan^ » ENGllK.RECOVEftY; /* engine: finish torque return */ 

control engine recovtry<); 

> 

else 
< 

engine control > OVERRIDE DISABLED; 
CQomand ETC1 - C ETC1 NORMAL; 

> 

> 

/* if predip_mode had been forced, this is the place to clear its flag. */ 
/• But only clear it if the pedal is depressed. This is for the case when */ 
/* a false confirmed gear is seen but the driver actually is coasting down. */ 
if (accelerator_pedalj»sition > 4) 
forced j>redip « FALSE; 

> 

l^agma EJECT 



Besf Available Copy Hxhibit is 



* Function: contPol_tn9ine^idle 

* Description: 

* This function ssts th« engine controls for the idle mode. 
* 

static void control engine idle(void) 
i 

engine.control » OVERRIDE.OISABLED; 
coflinand_£TCl « C_ETC1_M0RlttL; 

engine status ^ ENGINE IDLE MODE; 
> " 

ipragma EJECT 



* FuKtion: control^englr»^»t«rt 

* DMcripttoiu 

* ThU function tttt th« enoins controls for the start mode. 

Static void control engine startCvoid) 
< 

engine control > OVERRIDE DISABLED; 
coBinand.ETCI « C_ETC1_M0RiUL; 

engine status - ENGINE START NODE; 
> ' 

ipra^na EJECT 



* Fi«tion: control^enQine.conprwsion_^brake 

* Oetcn'ption: 

* Thi« function controls the statt of the engine conpression brake. 

* The brake can be used during i^hifts to speed up the decel rate of 

* the input shaft. 

static void control engine compression brake(void) 
< 

if (engine cofrmunication active U 

(engine'status » ENgTnE SYNC MODE) && 
(shift type == UPSHIFT) && 
(input^speed^filtered > (gos ♦ 150)) && 
(destination^gear > 1) && 
(destination^gcar < 7) M 
( eng i ne_br ake_ava i I abl e ) && 

((dos^fedicted < dos _prdtd lin no jake) || eng brake assist)) 

< 

eng brake assist = TRLfE; 

else 

< 

eng brake assist = FALSE; 
> " ' 

eng_brake_assist « FALSE; /* debug - force false state for now */ 



fpragma EJECT 



* Fi*Ktion: detennine_90« 

* Description: 

* This function Bulitpliss th« destination gear ratio times the 

* output shaft speed for use in the ORL.CMOS module. 

* gos 3 <g)ear • (o)utput (s)peed 

static void determine gos(void) 
< 

/*** determine gos for the destination^gear ***/ 
^bx » trn_tbl.gear_ratioCdestination_gear ♦ GR_OFS]; 
"cx « output^speed^filtered; /* output speed */ 
asm mulu cxdx, bx; /* BIN 8 result V 

asm shrl "cxdx, iS; /* make BIN 0 V 

gos = _cx7 /* BIN 0 */ 

_bx = trn_tbl.gear_ratio[destination_gear ♦ GR_0FS1; 
~cx » *(uTnt *)&dos_fi I teredo- 
asm mul _cxdx, _bx; 
asm div _cxdx, #256; 
dgos » *Tint *)4_cx; 

gos_signed = (signed intXgos); /* allow signed math in other functions*/ 

/♦** determine gos for the "current^gear" ***/ 
_bx = trn_tbl.gear_ratioCcurrent_gear ♦ GR_0FS1; 
"cx s output speed"f iltered; "/* output"speed */ 
asm mulu cxdx, bx; /* BIN 8 result V 

asm shrl Icxdx, #8; /* make BIN 0 */ 

gos_current_gear = _cx; /* BIN 0 */ 



#pragma EJECT 



FuKtIm dtttrafne^shlftabi I tty.vw'i^l ts 
Description: 

This firction filters both the output speed and the rate of change of 
the output speed for use in the shiftability function. This function 
also calulates the rate of change of the input shaft based on the 
filtered value for the rate of change of the output shaft. 

The filters used in this function are required to get a high level of 
stability. The BIM 8 filter used here will provide a much smoother 
output which is needed to filter out driveline oscillations. 

Note: These calculations were placed in this iDodule because it is 
called on a regular 10 msec interval. These calculations should 
be placed in the pr_i_s_i.c96 nodule once shiftability is proven. 
These variables are'used in the SEL GEAR.C96 otodule. 



static void determine shiftability variables(void) 
C 

/* LPF coefficients: exp(-wT), T»0,010s */ 



#define 0$ LPF 


248 


/* 


0.9691 BIN 8 (0.50Hz) 


*/ 


#define 0OSFK1 


249 


/* 


0.9727 BIN 8 (0.44Hz) 


*/ 


#define EPTFK1 


252 


/* 


0.9844 BIN 8 (0.25Hz) 


*/ 


Ifdefine IS FK1 


235 


/* 


0,9219 BIN 8 (0.??Hz) 


*/ 


fdefine OS FKI 


236 


/* 


0.9219 BIN 8 (0.??Hz) 


*/ 


tfdefine DISFKl 


236 


/* 


0.9219 BIN 8 (0.??Hz) 


*/ 


#define LOW RANGE 


3197 


/* 


3.1224 BIN 10 


*/ 


#define BIN~10 


1024 









static long dos^f i Itered^binS; 
static int ept_7i ltered_bin8; 

unsigned long is_filtered _partial_1; 
unsigned long is"f i ltered_partial~2; 
un8igned long os"f iltered^partial^lj- 
unsigned long os_f i ltered_partial_2; 
/** create I pf ^output^accel **/ 

_bx « *(uint *)&output speed accel; /* bx = x(n), BIN 0 */ 

"cx » *(uint *)4lpf output accel - bx; /* ~cx ^ y(n-1) - x(n), BIN 0 V 

asn (nul cxdx, #0S LPF; " " /• cxdx s k*(...). BIN 8 V 

asffi div cxdx, #256; make BIN 0 V 

_bx _cx; /• _bx ■ x(n) ♦ IC*(...), BIN 0 

Tpf_output_accel = *(int *)&_bx; /* save acceleration V 

dos_filtered = (dosjiltered ♦ OOSFICI) ♦ (lpf_output_accel • (1-OOSFKl) ♦*/ 

_cxdx « •(ulong ♦)&dos.f i ltered_.bin8; /* BIN 8 V 

asa shral cxdx, #2; * " /* BIN 6 ( cx) */ 

asm iBul cxdx, «D0SFK1; /* BIN 14 V 

asa shral .cxdx, #6; /* BIN 8 •/ 

dos_.fi I tered.binS » Miong *>4.cxdx; /* save partial result */ 

cx ■ *(uint *)&lpf output aceel; /* BIN 0 */ 

"bx « 256 - D0SFK1;" ~ /* 1 BIN 8 - DOSFKI V 

asm mul .cxdx, .bx; /• BIN 8 ♦/ 

dos_f i ltered_bin8 ♦» *(long *)4.cxdx; /* sua is final result */ 

dos.filtered » (intXdosJ iltered.bfnd » 8); /* BIN 0 V 

/•* engj)ercent torque filtered a (eng.percent torque filtered ♦ EPTFKl) ♦ 
<net*engine.pct.trq • (l-EPTFKI) *V 

cx » *(uint *)4ept filtered bin8; 7* BIN 8 V 

asm nul cxdx, #EPTFIC1; " . /* BIN 16 •/ 

asm shral _cxdx, #8; /* BIN 8 V 

ept.fi I tered_bin8 s *(int *)&.cx; /* save partial result V 

cx » net engine.pct trq; /* BIN 0 V 

.bx ■ 256'- EPTFKI; * /* 1 BIN 8 - EPTFK1 V 

asa nul cxdx, bx; /* BIN 8 V 

ept.fi I tered.bin8 *(int •)»_cx; /• sua is final result V 



# 


/* 


BIN 4 


*/ 




/* 


SIN 6 


*/ 




/* 


BIN 12 


V 




/• 


BIN 8 


*/ 


t 


/* 


BIN 8 


♦/ 




/* 


BIN 0 


♦/ 




/* 


1 BIN 8 - 


IS FK1 */ 




/* 


BIN 8 


*/ 


1 


/* 


BIN 8 


*/ 



wrgjpmrcmt^xor^JWfrmd » (charXtpt.f Uter«d_bir^ » 8); 

/*♦ Input.shaft.ecctl.calajlated « dos^fUtertd * gear-ratio 

cx • tm tbl.gtar^ratioCdeati nation gear ^ GR OFS}; /• BIN 8 V 
*bx • •(uTnt •)tdo«J«lterad; ~ ~ /* BIN 0 */ 

asa oul _cxdx, Jax; /* BIN 8 */ 

asn shral _cxdx7 #8; /* BIN 0 */ 

input_shaft_accel^calculated « •(int *)&_cx; 

/*•* calculate filtered input and output shaft speeds for AutoSplit ***/ 

/*** determine os_based_on_rcs variable ***/ 
if (output speed OOOO) 
{ 

bx « aux speed; /* SIM 0 V 

"cx » BIN"10; /* BIN 10 V 

3ax » LOW~RANGE; /* BIN 10 */ 

asn aulu ~cxdx« _bx; /* make aux^speed BIN 10 V 

asm divu .cxdx, "ax; /* divide by low range BIN 10 */ 

OS based on res = cx; /* BIN 0 V 

> " 

/*♦ input speed filtered = (input speed filtered * IS FKl) ♦ 
(input .speed * (l-IS.FKI) **/ 

ax " (is filtered binS » 
Zcx ■ IS_FK1 ; 
aso) oulu _axbx, _cx ; 
asm shrl _axbx, i4 ; 
i8_f i ltered_partial_l = _a 

cx » input speed ; 
2ax a 256 -"lS_FK1 ; 
asm mulu _axbx, _cx ; 
is_filtered __partTal_2 = _a 

is_f iltered_bin8 = is_f i lteredjjartial_1 ♦ is_f i lteredj)artial_2 ; 

input.speed^f liter ed = (unsigned int)( is.f i ltered_bin8 » 8); /* BIN 0 */ 

/*• output speed filtered = (output speed filtered ♦ OS FKl) ♦ 
" (output_speed * (T-0S^Fici) **/ 

ax = (OS filtered bin8 » 4) ; /* BIN 4 */ 

"cx a OS.FICI ; " /* BIN 8 */ 

asm mulu axbx, cx ; /* BIN 12 */ 

asm shrl "axbx, #4-; . /* BIN 8 V 

os_filteredj»rtialJ = ^axbx ; /* BIN 8 V 

#if (0) 

if (output.speed < 250) 
_cx a os_based_on_rcs; /* BIN 0 */ 

else 
#endif 

_cx 3 output^speed ; /* BIN 0 */ 

_ax ■ 256 - OS^FKl ; /* 1 BIN 8 - 0S_FIC1 •/ 

asm mulu axbx, cx ; /* BIN 8 */ 

os_filtered ^rtTal.2 ■ _axbx ; /* BIN 8 V 

os_f iltered_bin8 » oa^filtered _^rtial_1 ♦ os_f ilteredj)artial_2 ; 

output_speed_f!ltered » (unsigned int)(os_f i Itered^binB » 8); /• BIN 0 */ 

/*♦ input_speed_acceljiltered « (irput.speed.accelj i Itered * DISFKI) ♦ (input,shaft_accel * <1-01SFK1) 

_cxdx « •(ulong *)&dis filtered bin8; /* BIN 8 */ 

asm shral cxdx, #4; " * /* BIN 4 ( cx) •/ 

asm oul cxdx, JWISFKl; /* BIN 12 " V 

asm shraT _cxdx, #4; /* BIN 8 */ 

dis.fi I tered_bin8 = '(long *)4^cxdx; /* save partial result */ 

.cx « *(uint *)4input speed accel; /* BIN 0 •/ 

_bx » 256 - OISFKl; " * /• 1 BIN 8 - DISFKI V 

aso oul _cxdx, .bx; /• BIN 8 V 

dia_f iltcred.binS ♦» ♦(long •)l.cxdx; /* sia is final result V 



trput.spMd.acc«l.fUt«rtd « <im)(dUJUt«r«d.bin8 » d>: /• m 0 V 

/** dtt*f«fne state of clutch /•^im this is tesporary mtU we get */ 

/*^ clutch state over J1939. IM*^/ 

#if <0) 

if (engfne.speed > input.speed) 

clutch^sTip^speed « er^i ne^speed - input_speed; 
else 

clutch_slip_speed « input_speed - engine_spe€d; 

if (clutch^slip^speed > 200) 
clutch,state"» OISEHGACEO; 
else 

if {(engine speed > 700) && (low speed latch » FALSE)) 
clutch state « ENGAGED; /* Note: 700 should be idle*100RPM */ 

#endif 

/*♦* Below is a known undesirable condition that could be corrected with the J1939 
clutch state information. When input speed is brought below 700 RPM 
while in gear and the clutch is disengaged to acheive gear box neutral this 
algorithm holds the system in the follower mode until the driver bring the 
engine speed above the 700 RPM limit. The 700 RPM limit is needed to prevent 
false ENGAGED indications at idle speeds. **V 



/** determine desired percent torque needed for zero torque at flywheel **/ 
#if CO) 

/* This does not work but was not a problem to hard code a value 
because the accessory loading in this vehicle does not change 
much. This algorithm DOES need to work for the product. */ 
if ((accelerator_pedal_f)03ition < 2) && 
(clutch_state » ENGAGED) U 
(current^gear 0) && 
(input speed filtered < 1100) && 
(((engTne_control OVERRIOE.OISABLED) && 
(low_speed_latch =» FALSE) il (current_gear » 0)) || 
(output_speed_f iltered < 20))) 
percent torque accessories » eng^percent torque filtered; /* get at idle */ 
#endif 

percent_torque_accessories » 3; /* force value for now */ 

needed _percent_for_zero_f lywheel^trq » percent_torque_accessorie8 ♦ (--^- 

norai na I _f r i c t i on__pc t^t rq; 

/** determine overall error across the transmission •*/ 

overal l_error = ((signed int)( input_speed_f i Itered) - (signed int)(go8)); 



#pragma EJECT 



Function: cotmuiicatt.with_drlv«linc 



* OMcrlption: 

* ThU is the periodic task uhich controls the actions of the engine 

* by defining node of control end controlling speed and torque output 

* levels depending upon the control function being performed. This taslc 

* is also intended for control of other drivel ine components (not yet 

* naoed) which may be available in the future. 

*^««***#««««*««**««***«*#««********«*#****«*«******«««*******««*«***«**/ 

void CQOiDunicate uith drivel ine(void) 

i ni t i a I i ze^dr i vel i ne_data( ) ; 

X start_periodic(); 

krfiile (1) 

i 

cont rol_eng i ne^compress i on_brake< ) ; 

determine_gos(); /* calculate (G)ear times the (Output (S)haft •/ 
determine^shiftabi lity.variablesOj- 
if ((engine cooinLnication active) && 

(R7A7 type !» 8ASE) && 

(R747"type DUAL FORCE)) 

( 

if ((desired_sync_test_mod€ »= TRUE) && (output_spe€d^f iltered < 100)) 
c on t r o I _eng i ne_sync_ t es t _mode ( ) ; 

else 

i /* start of normal eng i ne^coomands switch */ 

switch (engine conmands) 
i 

case ENGINE.PREOIP: 

controlling ine _predip<); 
break; 

case £NGINE_SYMC: 

cont ro I _eng i ne^sync ( ) ; 
break; 

case ENGINE_RECOVERY: 

c on t r 0 1 _eng i ne_r ec o very ( ) ; 
break; 

case ENGINE.IOLE: 

control^engine_idle(); 
break; 

case ENGINE.$TA8T: 

controlling ine^atartC ); 
break; 

case ENGlNE^FOtLCftCtt 
default: 

cont rol.en^lne^f oi loiier( ) ; 

break; 

> 

> /* end of normal engine^conroands switch */ 

switch (eng brake coraaand) 

i 

case ENG BRAKE OFF: 

retarder.control = TC»Ql«.CONTROl; 
desired^retarder jxt_trq ■ 0; 
break; 

case ENG BRAKE FULL: 

retarder.control « TORQUE.CONTROL; 
desired^retarder^t.trq « -100; 
break; 

case ENG.6RAKE.IDLE: 



dtfautt: 

r«tardBr_contro( « OvmiOE^OISAStED; 
br««k; " 

> 

> 

else 

engine^status » E«CINE_»K)T^PftES£NT; 

/* store old value for ust in "control_en9ine_fol lower" function 
accelerator _pedal _position_old • accelerator _pedal_position; 

x_sync_per i od i c <US_PER_LOOP ) ; 

,end_pcriodic(); 



Unpi^lftlMd and conf idtntiai. Hot to b« reproduced, 
dfSMilnated, trmftrrtd or used without the prior 
' written consent of Eatorv Corporation. 

' Copyright Eaton Corporation, 1994 

' All rights reserved. 

' Filename: pr_s_i_s.c96 (R-747) (AutoSplit) 
' Description: 

^ The nodules contained within this compilation unit are 
' intended to implement functionality of the Process Systea 
' Input Signals task defined in the design docunention. 
' In general, Analog to digital conversions are started on 
' PortO, The necessary hardware initialization and variable 
^ initial iztion for ir^ts on PortO are handled. The switch 
' inputs are captured to avoid conflict with AO conversions 
' and all necessary scaling and error check for these inputs 
' is conducted. 

' Part Nunber: <none> 

' $Log: ? 

' Rev 1.3 9 Dec 1994 15:06: markyvech 

f Added "trns^act.h" to the includes so that R747_typc could be use to 
' determine if the electric shift knob is a splitter type or a intent to 
' shift type, 

' Rev 1.2 6 Dec 1994 15:06: markyvech 

' Converted for use with R-747 program. (Added clutch & range switches) 
' Also re-scaled ECU-B ignition A20 code to work in ECU-II. 

' Rev 1.1 19 Hay 1994 11:32:26 markyvech 
' Converted for use with AutoSplit ECU2 

' Rev 1.0 12 Sep 1991 08:04:26 amsallen 
' Initial revision. 



* 

* Header files included. 
* 



#include <exec.h> /* executive information */ 

finclude <kr 3fr.h> /* KR special function registers */ 

#include <kr3def.h> /♦ KR definitions V 

#include <c^regs.h> /* KR internal register definitions */ 

#include <wwslib.h> /* world wide software definitions V 

#include "pr^s^i.s.h* /* process system input signal information */ 

#include "sysgenTh" /* defines the task names and priority */ 
#include "cont sys.h* 
#include "trns"act.h» 



^»#*<HHi# a < ■ < a « 

* #defines local to this file. 

/* Star t_AO_Convers ions */ 

tfdefine ENABLE AO PTS SCAN 0X20 
#define ENABLEIaoJSR"0X2O 

«define PERIOD 10U 
#define RKM PERIOD SOU 



/♦ 10ms */ 
/* 50ms V 



* Constanta and variables declared by thU file* 
* 



/* Digital Inputs on Porti •/ 

uchar splittep_select_8witch; 
uchar intent_to_shif t_swi tch; 
uchar intent_hoTd; 
uchar intent'hold^tioer; 
uchar range^select^swi tch; 
uchar in^gear^swi tch; 
uchar spTi tter_launch_state; 
uchar clutch_state; 

/* Analog Inputs on PortO */ 

int ignition_volts; 
\nt splitter^osition; 

#define IGNITION VOLTS CHANNEL RESULT 1 
#define SPLITTER"poS CHANNEL RESULT 15 



«define CONVERSION TIME Oxef 



#define CONVERT 8 8 



/* for state tine » 125 nsec: */ 
/* sample time » 3.6250 usee V 
/* convert time » 20.1875 usee */ 
/* scan and convert 8 channels */ 



#define CONVERT^IGNITION^VOLTS 
iWefine UNUSED CHANNEL T 
#define UNUSE0"chanN£L"2 
#d€fine UNUSED~CHANN£l"3 
#define UNUSED"channEl"4 
#define UNUS£D"channEL~5 
#define UNUSED"chaNNEl"6 
#define CONVERT SPLITTER POS 
#define STOP CONVERSION ~ 
#define START CONVERSIONS 



( norm^mooe 
("norm'mooe 
<'norh~mooe 
<"norm"mooe 
("norm'mooe 
("morm"mooe 
("norm'mooe 
("norn"mooe 

0x00 
ad cofimand 



10 BIT MODE 

"io'bit'mooe 
■io"bit mode 
'io'bit mode 
"io'bit'mooe 

'10 BIT MODE 
"10"8IT MODE 

'io"bit"mooe 



STRT 

strt" 
"strt" 
"strt" 
'strt" 
"strt" 
"strt" 
"strt" 



CONV 
CONV 
CONV 
CONV 
CONV 
CONV 
CONV 
CONV 



.CHNL^O) 

chnl"i) 

'CHNL~2) 
CHNL 3} 
CHNL 4) 
CHNL 5) 

"chNL"6) 
CHNL 7) 



= CONVERT IGNITION VOLTS 



/* table containing AD_result and AD_Coninand values after PTS scan */ 
unsigned int AO_TablecT63 ; 

/* AD SCAN PTS CONTROL BLOCK LOCATION */ 
_adj)tsb_type AD_Con_atock; 

ipragma Tocate(A0_Con_Block=0x01F8) /* locate pts control block */ 
#pragma pts<AO_Con_Block = 5) /* set pts vector 5, A/O done */ 



^pragma EJECT 



Description: 

This routine initialiZM the A/0 converter. It sets the A/D to 
run in PTS scan Bodt, lObit conversion. The PTS control block is 
set up and the Coenand/ result table is initialized. 



void Initialize Input Signals<void) 
i 

/* if we knew when the first speed packet arrived, we could initialize 
with those values, since we don't, be safe and use zero. */ 



AD Table CO] 

A0"T8ble[11 

AD~TableC2] 

A0"TableC3l 

A0~TableC4] 

AD"Table(53 

A0_Table(6] 

AD"TableC7) 

AO^TableCS} 

A0"TableC9) 

A0~TableC10] 

A0"TableC11l 

AO~TableC123 

A0"Table(13l 

A0"TableC141 

AD^TableCIS) 



3 UNUSE0_CHAWNEL.1; 
s 0x0000; 

■ UMUS£D_CHANNEL.2; 
3 Ox00007 

» UHUSED_CMAWNEL_3; 
s 0x0000; 

« UHUSE0_CHAMNEL.4; 
a OxOOOOj 

» UNUSED,CHANNEL_5; 
3 OxOOOOj 

« UMUSED_CHANNEL_6; 
= OxOOOOT 

= C0NVERT_SPLITTER_POS; 
= 0x0000; 

= STOP_CONVERSION; 
= 0x0000; 



/• 
/* 
/• 
/* 
/* 
/• 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 



place holder for channel 1 
I GN I T 1 0>l_VOLTS_CHANHEL_RESULT 
place holder for channel 2 
UNUSE0J_RESULT 
place holder for channel 3 
UNUSED_2_RESUtT 
place holder for channel 4 
UKUSED_3_RESULT 
place holder for channel 5 
UNUSED_4_RESULT 
place hoTder for channel 6 
UNUSEDJ_RESULT 
Conmand convert splitter pos 
UNUSED_6_RESULT 
coomand to Stop conversions 
SPLITTER POS CHANNEL RESULT 



AO Con Slock. cnt = CONVERT 8; 
AO^Con^Block.ctrl » _AD_MOOE |_S_0_UPOT; 



/* A/D mode bits 0,1 of PTS_CONTROL V 

/* always set to 3h bit 2 s 0 V 

/* S/D update at end of cycle */ 

/* bit 5 always 0 */ 

/* Set mode for AO SCAN ♦/ 



A0_Con_8lock.s_d s A0_Table; 
A0_Con_Block.reg » (void *)i_ad_result; 

^ad^time = CON VERS I ONETIME; 

"ad"test 3 MO OFFS; 

J5ts select &= "( PTS ADOONE BIT); 



/* Load s_d with AD_Table address 
/* Load reg with AO_Result address 



/* Disable test mode */ 
/* Disable AO PTS */ 



*/ 
*/ 



#pra9ma EJECT 



• Function: AOJSa 



* Oetcription: 

* This inttrupt service routine resets the PTSCOUMT, pts^sd and pts^reg 

* for another PTS_Sc«n A/0 cycle. It also readies a task'to run when 

* a PTS cycle has couplet ed. 
* 

ipragroa interruptCAO 1SR«5) 

void AO ISR(void) 

i 

x_start_isr(); 

AD_Con_Block.cnt = C0NVERT_8; /* Reset pts count for next cycle */ 

Ao2con~Block.s_d « AO_Table; /* Reset table pointer to start of table 

AD^Con^Block.reg 3 (void *)4_ad^result; 

x_ready(PROCESS_INPUT_SIGNAlS); /* Ready pr_s_i_s task •/ 

X end isrO; 



#pragma EJECT 



* PuKtlon: Start^AD.Convermlons 

* O»»criptlon: 

* Thi» function initialiies the input signal processing function 

* if it has not alrtady bten done« and then startes the PTS Scan 

* of the AO charr«it by sending thm appropriate connand to the 

* ad^CQonand register. 

void Start AD Conversions(void) 
{ ' " 

if (( int mask & ENABLE AO ISR) » 0 ) 

InTtiaTize_Input_Signal3<); /* Set up AO table for PTS V 

J3ts select |s ENABLE AO PTS SCAN; 
_intlroask |s eNA8LE_A0_ISR; " 

x_prearm_st i mul usO ; 

START.CONVERSIOMS; /* Start a conversion, initiate the PTS cycles •/ 

X wait stimulusO; /* AO ISR will ready task when PTS is complete V 
} " ■ 

^pragma EJECT 



Function: rcad_syitch_inputs 



Description: 

Read the state of the digital inputs. 



void read switch inputsCvoid) 
( * " 

if (port^l^switches & 0x1) /• P1.0 V 

in_9ear_swi tch » TRUE; 
else~ 

in_gear_swi tch » FALSE; 

if ( por t J _sw itches & 0x2) /* P1.1 ♦/ 

range^seTect^swi tch = LOW; 
else 

range_select^switch = HIGH; 



if <R747 type =» INTENT) 
C 

if (port 1 switches & OxA) /* P1.2 */ 
intent_to_shift_switch = FALSE; 




if (intent_hold_timer < 25) 

intent_hold_timer += 1; 
else 

intent hold = FALSE; 

> 

else 
i 

intent_to_shift_switch = TRUE; 
intent hold timer = 0; 

} 

> 

else 
i 

if (port_1_switches & 0x4) /* P1.2 */ 

splitter"select_switch = HIGH; 
else 

splitter select switch ^ LOW; 

> 

if ({port_2_switches & 0x30) == (0x10)) 

clutch^state = ENGAGED; 
else 

clutch.state ^ DISENGAGED; 

#if (0) 

if (port_1_switche8 & 0x4) 

splitter~lauKh_8tate « LO^SPLITTER; 
else 

splitter launch state « HI SPLITTER; 
#endif 

splitter_launch_state » LO.SPLITTER; 



#pra9nia EJECT 



* Fwtion: proc««»Jnput.f lfln«l» 

* Description: 

* This is the periodic task which starts the analog conversions on PortO. 

void process input signalsCvoid) 
i 

intent^hold = FALSE; /* initialize intent_hold */ 

x_start_per i od i c( ) ; 

uhile (1) 

< 

read_swi tch_i nputs( ) ; 

S t a r t _AD_Conve r s i ons <) ; 

/* Clean up and scale AO values V 

ignition_volts = scale_systefn_ad_inputs< IGMITI0N_V0LTAGE); 
8pl itterj»si tion » 3cale_syste«3»d_inputs(SPLITTER_POSITIOM); 

X sync_periodic(PERI00*1000); 
/* X sync _periodic(RKM PERIOO*1000); */ 
> " 

X end_periodic( ); 

> 

^pragma EJECT 



* FtfKtion: scalt^systear^ad^inputs 

* Description: 

* This function reoioves the channel, status and reserved bits from 

* the raw AO values, and perfonna all necessary scaling and error 

* checking for the analog inputs on PortO. 

int scale systeoi ad inputsCchar Channel) 
{ 

int Scaled Value » 0; 
uint voltsj)er_bit; /* BIN 16 V 
uint units^r"bit; /• BIN 16 •/ 
/♦ #define TWELVE VOLT FULL SCALE 22.46 */ /* ECU B volts */ 

#define TWELVE VOLT FULL SCALE 34,51 /* ECU 2 volts V 

#define TWENTY FOUR VOLT FULL SCALE 40,49 /* volts */ 
#define DISTANCE FULL SCALE * 100 /* */ 



volt8j)er_bit = (uint)((TWELVE_VOLT FULL SCALE *65 536/ 1023) +0.5); 
units^r"bit ^ (uint )( (01 STANCE_FULL_SCALE*65536/ 1023 )'*-0.5); 

switch (Channel) 
i 

case 0: /* IGNITION VOLTAGE */ 

_cx « AD_TableCIGNITI0N_VOLTS_CHANNEL_RESULT] » 6; 

asm mulu" cxdx, volts_per bitj /* volts, BIN 16 (_dx, BIN 0) */ 

Scaled^VaTue = *(int *)&_dx; 

break; 

case 1: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled_Value = (0); 
break; 

case 2: /* UNUSED */ /* to be conpleted when a product requires it */ 
Scaled_Value = (0); 
break; 

case 3: /* UNUSED V /* to be conpleted when a product requires it V 
Scaled^Value = (0); 
break; 

case 4: /♦ UNUSED */ /* to be cotnpleted when a product requires it */ 
Scaled.Value = (0); 
break; 

case 5: /* UNUSED */ /* to be conpleted when a product requires it */ 
Scaled^Value > (0); 
break; 

case 6: /* UNUSED */ /* to be conpleted when a proAict requires it */ 
Scaled.Value 3 (O); 
break;" 

case 7: /• SPUTTER POSITIOH V 

_cx « AO_T^leCSPtITTW_POS^CHAIHIfLJESULT) » 6; 

asm mulu cxdx, unSts^r bit; /^"distance, BIN 16 ( dx, BIN 0) V 

Scaled^VaTus ■ •(Int ♦)i^l«; 

break; 

default: 
break; 

> 

return (Scaled^Value); 



UnpubUfth#d and conf fdtntial. Not to bt reproduced, 
d1«t«a1neted« trensf erred or used without the prior 
written content of Eaton Corporation. 

Copyright Eaton Corporation, 1991-94. 
Ail rights reserved. 



* Filename: seq_shft.c96 <R-747) (AutoSplit) 
• 

* Description: 

* The functions in this file wilt perform the required system 

* level operations for inplementing Sequence Shift. 
* 

* Part Ntinber: <none> 
* 

* Rev 1.2 12 Dec 1994 09:15 raarkyvech 

* In function »sequence_shif t()" added code for the intent_hold. 

* Rev 1.1 09 Dec 1994 06:07 markyvech 

* In function "sequence_shif t()" added code for the intent to shift 

* feature. This will allow shi ft_ini tiate, (predip mode), to be called. 

* Also added code to allow for the cancellation of intent to shift if 

* conditions allow, (call confirm shift). 



* 



Rev 1.0 12 May 1994 16:26:00 markyvech 
Initial version 



* Header files included. 
* 



^include <exec.h> /* executive information ♦/ 

#include <c_regs.h> /* KR internal registers */ 

#include <wwslib.h> /* World Uide Software library */ 

#include "coni^sys . h" /* control system information */ 

# include "conj1939.h" /* Defines interface to engine cocrmuni cat ions info 

^include "con^o^s.h" /* control output signal information */ 

#include "drl"cmds.h» /* drivel ine commands information V 

#includc "seCgear.h" 

#include "shf^tbl.h" /* Contains information relative to engine */ 

#include "trn"tbl.h" /* transmission table information */ 

#include "trns_act.h" /* transmission information */ 

#include »pr_s_i_s.h" /* process system input signals information */ 



* 

* #defines local to this fUe. 



/********** 
* 

* publics. 
* 



iroigned char forced_predip_timer; 
unsigned char init^dest_gear_timer; 
signed char ini tTal^<testination_gear; 



* 

* Constants and variables declared by this file. 

static uchar coast.mode; /* allows veh-icle to coast in low gears */ 

#def ine FC»CEO PREDIP TIME 150 /* 300 MSEC at 5 counts per loop */ 

#define IM.SYMC.MOOE JiME.LIMIT 200 /* 2 SEC •/ 



• 

* Description: 

* This function initislizts thoss nodule variables that oust be set to 

* know state on power up or reset. 

void initialize sequence shift (void) 
< 

shift_type » UPSHIFT; 
8hift^in_process » FALSE; 
forced_predip^ timer » 0; 



ipragma EJECT 



* FuKtion: shiftJnitUtt 



* Description: 

* This fwtion begin* the shift sequence by setting up the 

^ transmission to pull to Neutral, cosntands the electronic engine 

* controller to go to zero torque end prepares the clutch to disengage 

* if required. 



static void shift initiate(void) 
i 

/* (do not request engine fueling uith engine brake on) */ 
eng_brake^coninand * ENG_BRAICE_OFF; /* eng brake: zero torque */ 

((lpf_output_speed < shf^tbl .min_output^spd) || 

(clutch.state == OISENGAGEO) || 

<(coast_fnode) && (shift_type !» UPSHIFT) /* Prevents engine control */ 

<<destination_gear < 3)"|| /* in low gear<s) downshifts. V 

((destination"gear < 4) (acceleratorj^edal^position 5))))) 

C 

engine commands - ENG1NE_F0LL0UER; 

> 

else 
i 

engine_co(nmands = ENGINE_PREDIP; /* engine: bring torque to zero */ 

coast mode = FALSE; 

> 

> 

i^agma EJECT 



* 

* Fulction: synch ronUe^^gear 
• 

* Description: 

* This function assists the sychronizing of the transmission by 

* utilizing SA£ J1939 functions to control an electronic engine. 



static void synchronize gear<void) 
< 

/* turn on engine brakes (J 1939) if engine brake assisted shift is requested V 

if (eng brake assist) 

eng_brake.cociinand « ENG^BRAICE_FULL; 
else 

eng_brake_coninand ^ ENG_BRAICE_OFF; 
if <(lpf_output_speed < shf_tbl .(Bin_output_spd) || 
(clutch.state » DISENGAGED) || 

<(coast_inode) && (shift_type 1* UPSHIFT) && /* Prevents engine control */ 
<(destination_gear < 3) | | /* in low gear(s) downshifts. */ 

((destination~gear < 4) && (accelerator_pedal_posi tion 5))))) 

engine^conmands = ENGINE_FOLLOWER; 



Ise 

engine^commands = ENGINE^SYNC; 
coast^^inode = FALSE; 



f <(engine_status != ENGINE_SYNC_MOOE) && 
(engine'coaimands == ENGINE_SYNC)) 
ini t_dest_gear_ti(ner » 0 ; 

f (init_dest_gear_tin»er < 8) 

ini tial^dest ination_gear = destinat ion^gear^selected^- 
ini t_dest_gear_t imer++; 



/* Save the initial gear */ 
/* to check for a new one V 
/* as the shift progresses. V 



else 



if ((engine^status == EMGINE_SYNC_MO0E) && 

(initial destination gear |s destination gear selected)) 

i 

forced_predip_ti(ner = F0RCED_PRED1P.T1M£; 
forced_^redip » TRUE; 



> 



/* If the gear changes, V 
/« force the predip mode V 
/* to allow the splitter */ 
/* to move. */ 



#pragma EJECT 



• Fmction: conf irm^shift 

♦ "* 

* Description: 

* This function finishes the shift; shif t_in_j)rocess is set FALSE. 

static void confirm shift(void) 
C 

engine^conwands » EMGIME^RECOVERY; /* engine: finish torque return 

eng_brake_co(iinand = ENG_BRAICE_OFF; /* eng brake: zero torque */ 

shift_in_process » FALSE; 
coast^mode « TRUE; 



fpragma EJECT 



* Function: saquence^shif t 

* Description: 

* This function calls the appropriate procedures to perform the 

* operations of Sequence^Shif t depending on the current state of 

* the shift process. 



void sequence shift(void) 
< 



if (destination gear < last known gear) /* determine shift type */ 
< 

if (pct_defnand_at_cur_sp > 5) 

shift'type ■"POWER^OOWN^SHIFT; 
else 

shift type = COAST DOWN SHIFT; 

> 

else 

shift_type = UPSHIFT; 

if ((forced j5redip_timer >= 4) 4* /* Time out a forced return to the predip node V 
(g_ptr " 0)) " /* if the destination gear selected changes */ 

forced_predip_timer -= 4; /* during the sync mode. */ 

if (forced_predip_timer > 0) 
f orced_predi p_tTmer- - ; 

if (destination gear « NULL GEAR) /* System has reset: do not start a shift */ 

engine commands = ENGINE FOLLOWER; 
eng brake command = ENG BRAKE IDLE; 
> ■ " 

else 

if ((transmissionj»sition == OUT_OF^GEAR) && 
(forcedj)redip timer == 0) &4 
((engine status"=- ENGINE SYNC MODE) || 

(engine"status == £NGINE"pREdTp MODE))) /• forces shift initiateO */ ; 

c ' " " " y 

synchronize gearO; 



else 

if ((((engine status ENGINE SYNC MODE) || 

(engine^status == ENGINE~RECOVERY_MOO£)) && 
(forced ^redip^timer 0) && 
(destination^gear current_gear) && 
(transmission_j)osi tion =3 IN^GEAR)) || 

((shift^injjrocess == TRUE) && /* cancel intent to shift if */ 

(intent^to shift^switch «« FALSE) &i /* conditions allow it. V 
(8hiftjnit^typ#"»» MANUAL) U 
(autointttfc.sip » 0) tt 
(transaissTon^^position «* li GEAR) t& 
(engine status » ENGIKE PRfOIP NODE))) 

{ 

conf inD_shift(>; 



else 

if (((destination_gear !» current_gear) && /* auto splitter */ 
(low_3peed_latch »■ FALSE) M~ 
( automat ic^sip 1= 0) && 
(transmission^position 3s IN_GEAR)) || 

((intent_to_shift_switch " TRUE) && /* Allows for intent_to.shift 

(desired gear !=~desti nation gear selected) && /* manual shift. 
(intent_hold == FALSE) « " ~ 
(automatic sip 0) U 
(shift init type » MANUAL) && 
(low_speedJatch FALSE) U 
(transmission ^sition " lM_GEAft)) || 



((tr«n8aiMfoo.posit1an OUT Of (ZAR) U /* avual shift V 
(toM $p*«d^Utd» •« FALSC))} " 

( 

shift initiat«<); 

> 



Unpublished and conf idtntUi. Mot to be reproduced, 
disscnineted, transferred or used without the prior 
tfrftten consent of Eaton Corporation. 

Copyright Eaton Corporation, 1993-94, 
AU rights reserved. 



Filename: sel gear.c96 



(R-747) (AutoSplit) 



* Description: 

* This module is the periodic task "select_gear". It assigns values 

* to destination_gear_selected as a function of selected_mode, input 

* and output shaft speeds. 

* Shift parameters are in the data structure shf_tbl. 

* *" 

* Part Number: <none> 
* 

* Rev 1.1 12 Dec 1994 08:05 tnarkyvech 

* In function "deterinine_manual_shift_pts()", changed auto__up_rpBi from 

* 1350 RPH to 1425 RPM because the transmission has been changed to a "B" 

* ratio and skip upshifts need to be avoided.' 
* 

* Rev 1.0 14 Sep 1994 14:02:00 markyvech 

* Initial revision. 



* Header files included. 



#include <exec.h> 
#inctude <c_regs.h> 
#include <wuslib.h> 
#include "cont_sys.h" 
#include "conjT939,h" ^ 
#include "drl^cmds.h" n 
#include "sel gear.h" 
#include "shf'tbl.h" 
#inctude "trn*tbl.h" r 
#include "calc^spd.h" 
#inctude "trns^act.h" 
#pragma no reentrant 



executive information */ 
c registers */ 

contains connon global defines V 
control system */ 

defines interface to j1939 control module 

drivel ine commands information V 

select gear */ 

shift table definition */ 

(system) transmission table definition */ 



* #defines local to this file. 
* 



#define US.PER.LOOP 40000) 

#def ine INITIAL^START^GEA* 1 

#define SHIFT INHIBIT OECEL IIHIT *150 



* Constants and variables declared by this file. 
* 



/* public V 

char destination_gear_selected; 

char dest i na t i on_gear ; 

char f lash_desi red_al lowed; 

char de8ired_gear; 

char desired_gear_dn; 

char desired_gear_up; 

uchar coasting_latch; 

uchar shif t_ini t_type; 

uint lpf_output~speed; 



<nt dos^«d1cted; /* BIM 0 V 



/• local V 

/• filter Mights for th« "oda" output speed filter ♦/ 
static register uchar w1; 
static register uchar u2; 
static register uchar w3; 
static register uchar w4; 

/• shift table (define and extern in shf_tbl.h) V 
struct shf_tbl_t shf^tbl; 



/* default shift table values */ 
const struct shf tbl t ini shf tbl » 
i 



1200, 


/* 


aut^dwn_rpni */ 


1000, 


/* 


aut_tBi n_dwn_rpra */ 


1700, 


/* 


aut_up_rpn */ 


o# 


/A 


Dest^gr^OTtset */ 


50, 


/* 


dwn^offset_rp« */ 


100, 


/* 


dwn*reset_rp« */ 


400, 


/* 


dwn_ti(ner_of fset_rpm */ 


40, 


/* 


hysteresis___rpm */ 


1850, 


/* 


man^dwn_sync_rpra */ 


700, 


/* 


man_up_sync_rpm */ 


1900, 


/* 


rated^rpm */ 


150, 


/ 


up_of f set_rpfn */ 




/ 




200, 


/* 


up~tiiner^offset_rpn> */ 


0, 


/* 


dwn^accel */ 


8, 


/* 


up_accel */ 


3000, 


/* 


offset_titne */ 


(uintXO, 25*256), 


/* 


aut_up|^t */ 


10, 


/* 


min_output_spd */ 


1. 


/♦ 


inax^start_gear */ 


0, 


/* 


pacfiytel */ 


196, 


/* 


k1 ability, mi n- ft/ rev- sec, BIN 12 */ 


431, 


/* 


axTe.ratio^cal, BIM 7 V 


383, 


/* 


gcw ici, rev/sec-min-ft, BIN 0 */ 


2437, 


/* 


gcw2k2, rev/sec'2, BIN 7 •/ 


1325, 


/* 


calc_start_point, rpm, BIN 0 */ 


107, 


/* 


k6_ability, mi n- lb- ft- sec/rev, BIN 8 */ 


1500, 


/* 


auto_up_lo_base, rpm, BIN 0 */ 


1100, 


/* 


auto_dn_lo_base, rpm, BIN 0 */ 


100, 


/* 


auto^rtd^offset, rpm, BIN 0 */ 


1000, 


/* 


I owes t_engage_rpm, BIN 0 */ 


0, 


/* 


padwordi ♦/ 


0 


/• 


padwordZ */ 



>; 



/* local initialized at start of task by select_gear */ 

/* shift points with antl*hunt offsets; referenced by auto_downshift and 

auto_upshift; set by get^automtlc^gMr and select^gear"*/ 
uint upshift^point; 
uint downshiftj5oint; 

/* lower limit for gear selections */ 
char lowest_forward; 

/* indicate direction of a get^8utomatic_gear shift; referenced by 

get_^manual_gear; cleared by'select_gear when shift complete ♦/ 
char automatic_sip; 

/* used in the determination of shift _points based on throttle position •/ 
static uint auto_up_rpB; 
static uint auto^^Irpm; 
static uint auto^up'of fset_rpra; 
static uint auto"dn"of fset^rpm; 

/* delay counter for ant i- hunt V 
static uchar antihunt.counter; 

/* gross CQobined weight calculations V 



M^flm ZERO SPEED TIME LUtlT 45W 
idtflrw VALID OLD SaTA TIME 100 
idtf int MAX VEHtCVE VCTCBT 100000 
idtfint DOS'OfPSET TmIT 48 
idefint EMG'oECEV LOU LIMIT -350 
idefine EHG*OECEL*LPF~ 224 



/* 3 af n a 0.04O p^lod V 
/* 4 sac a 0.040 period V 
/• 100,000 lbs V 

/* rpai/3 */ 

/• exp<-2pi<0,53Hz)(0.040s)) » 0.875 (BIM 8) V 



#if (0) 
static ulong 
static long 
static uint 
static ulong 
static uchar 
static uchar 
static uchar 
static uint 
static uchar 
static uchar 
static uint 
static 
static 
static uint 
static uchar 
static uint 
static 
static 
static 



int 
int 



int 
int 
int 



static uchar 



g r oss^c orb i ned^we i ^ t ; 

gcw.local; 

gcH^ I oca l_count er ; 

gcw_local_total; 

va I i d_o I d_da t a_c oun t e r ; 

missed_shi f t_of f s«t_arm; 

gcw^calcu I at i on_a 1 1 owed; 

zer o_speed_count er ; 

gcw_first^shift; 

dos_f i Iter^latch; 

gcH_cal_ne5; 

dos_f i 1 1 er ed_o I d; 

dos_offset; 

sync_de 1 1 a_t i tner ; 

dis^?ilter"latch; 

i nput_spd_f i r 8 tj)o i nt ; 

eng_decel3latest; 

eng_decel_rate; 

eng_dccel"rate_wth_jake; 

used_eng_brlc; 



/* shiftabiUty calculations */ 

#define TORQ ACC LPF 230 

#d€fine IC7_A8ILITY 249 

#define FIXED LIMIT -30 

#define FIXE0"lIM1TJ -36 

iSWefine SHF_BLY_HOLD_COUNT 3 

static uchar sh if tabi I i typhoid; 
static uchar shi ftabi I ity~hold_n; 
static uchar shf_bly_hold_cntr; 
static int dos_predicted_raw; 
static long dos_predicted_bin8; 
static long dos^predicted _partial_1; 
static long dos_predicted _partial_2; 
static int dosj3rdtd_l im_Hth_jake7 
static int vehicle_accel_b$; 
static int vehicle_accel_as; 
static int engine_7orque; 
static int torque~at_uheels; 
static int torq_^to^accel_eng; 
static uint gcw^caT; 
static uint TRAHS_STEP_SI2E_CAL; 
static uchar torque accessories; 
#endif 



/♦ lb-sec'2. BIN 0 */ 



/* 0.9000 BIN 8 V 
/* 0.9730 BIN 8 */ 



/* 120 ms a 0.040 period */ 



/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/• 
/* 
/♦ 



BIN 0 
BIN 8 
BIN 8 
BIN 8 
BIN 0 
BIN 
BIN 
BIN 
BIN 
BIN 



V 

*/ 
♦/ 
♦/ 
•/ 
•/ 
*/ 
*/ 
*/ 
*/ 



lb-sec'2, BIN 0 V 
§, BIM 8 */ 
Ib-ft, BIN 0 */ 



#pragma EJECT 



* Function: (ada^output_f Uttr 

* Oescpiption: 

* This is a one pole LPF with a variable coefficient. The nagnituda 

* of the coefficient is directly related to the acceleration content 

* of the speed sanple and th« frequency. 



static void.oida output filter(void) 
< 

tfdefine IC1 8 
#define K2 24 
#def ine IC3 48 
#define )C4 160 



static register uint os^delta^speed; 
static register uchar weight; 

(lpf_output_speed > output_speed) 
os_delta_speed = lpf_output_speed - output_speed; 
else 

os_delta_spe€d = output_speed - lpf_output_spe€d; 



if 
C 



(os_delta_speed <= K1) 

if <w1 > 1) "wl; 

if (w2 < 5) ++w2; 

if (u3 < 6) ++w3; 

if (w4 < 7) >+w4; 

weight = w1; 



else if (OS delta speed <= K2) 
i 

if (wl < 4) '►+W1; 
if (w2 > 2) "w2; 
if <w3 < 6) ++w3; 
if (tf4 < 7) ++W4; 
weight = w2; 

> 

else if (OS delta speed K3) 
C 

if (wl < 4)*+wl; 
if (w2 < 5) ++w2; 
if (w3 > 3) --w3; 
if (w4 < 7) ♦+w4; 
weight = w3; 



/* delta <= 200 rpm/s V 



/* 200 rpm/s < delta <= 600 rpm/s */ 



/* 600 rpm/s < delta <» 1200 rpm/s V 



else if (OS delta speed <^ K4} 
( 

4) ♦+w1; 

5) **w2; 



/* 1200 rpm/s < delta 4000 rpm/s */ 



if (wl 
if (w2 



if (w3 < 6) ♦♦w3; 



if (w4 
weight 



3) -•«4; 
w4; 



> 

else 



/* 4000 rpm/s < delta V 



if (wl < 4) ♦^V; 
if (w2 < 5) ♦♦w2; 
if (w3 < 6) 
if (w4 < 7) ♦*w4; 
weight = 7; 



lpf_output_speed « Ipf^output^speed ♦ 

7output~spe«d » weight) -"(lpf;_output_speed » weight); 



ipragroa EJECT 



* Finction: ae«_input^spe«d 

* Description: 

* A utility function that returns the input shaft speed expected if 

* "gear" was engaged with the present output shaft speed. 

static uint new input speedCchar gear) 
< 

/* ne«_input_speed = lpf_output_speed * gear_ratio */ 

_ax ■ trn_tbT,ge8r_ratioTgear ♦"gR_OFS); ~ /* BIN 8 */ 

asa nulu laxbx, I pf _output_speed; ~ /* SIM 0+8=8 <_axbx) V 

asm shrl ~ /* BIN 8»»0 (*ax) V 

return ax; 

> 



#pragina EJECT 



* Fuvtion: •uto^.i^hift 

* Description: 

* This boolean function returns true when automatic upshift 

* conditions have been met. 
* 

static int auto upshift (void) 
< 

if (<90S > upshiftjx)int) && (output speed filtered > 120)) 
< 

if (engine coniDuntcation active) 
{ " 

/* if ((lshift3bility_hold) U (Ishif tabi lity_holdJ 1)) V 
return 1; 

> 

> 

return 0; 



#pragma EJECT 



* Functfon: «uto_downshift 

• Description: 

* This boolean function returns true uhen autocnatic downshift 

• conditions have been asst. 

static int auto dounshif t(void) 
{ 

if <gos < downshift_point) 
< 

return 1; 

> 

return 0; 

> 

#pragma EJECT 



* function: det*ralnt.«itoap(jt_typt 

* Description: 

* This function is us«d to determine if the impending shift type is 

* MAKUAL or AUTO. 



Static char determine autosplit type<char passed new gear, char passed initial gear) 
i 

register char neu^gr = passed_new_gear; 
register char init_gr = passed_inTtial_gear; 

if ((shift inj)rocess » FALSE) || (engine status «> ENGINE RECOVERY MODE)) 



if 



((new^gr =« 
(new_gr ■« 
(new_gr 
(new^gr 
(ne«_gr =» 
(new^gr 
(new_gr -~ 
(new^gr == 
(new_gr 
(new^gr == 



1 U 

3 M 

5 && 

7 U 
9 && 

10 M 

8 U 

6 && 

4 && 

2 && 



shift_init_type = AUTO; 



t.gr 

t.gr 



2) 
4) 
6) 
8) 
10) 
9) 
7) 
5) 
3) 
D) 



an 

dn 
dn 
dn 
dn 
up 
up 
up 
up 
up 



*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
•/ 
*/ 
*/ 
*/ 



else 

shift_init_type = MANUAL; 



#pragma EJECT 



* Function: gct_autoraatic_9«ar 

* ~ 

* Description: 

* This function determines the appropriate gear for both automatic 

* splitter shifts and manual lever shifts. 
• 

static char get automatic gear(char initial gear, char manual request) 

register char new_gear = initial_gear; 

if (automatic sip != -1) 
{ 

/* initiate or continue an upshift: search up from lowest^forward 

(fastest input speed) for the first available gear that uill provide input 
speed below a value (approx upshift rpm, minus an offset for gears that wUl 
result in a net downshift) V 

for (new_gear = lowest_forward; 

(new_input_speed(new_9ear) > (upshift _point - 
(new_gear < initial^gear ? 

(shf_tbl .up_offset_rpm ♦ auto_dn_of fset_rpm) : shf^tbl .best_gr_of fset))) 
&& (new_gear < trn_tbl .highest_forward); 
++new_gear) 



if (( ini tial_gear == 3) && ((new^gear ==2) || (new_gear == 1))) 

new_gear = ini tial_gear; 
desi^ed_gear = new_gear; 
desired_gear_up = new_gear; 

determi ne^autospl i t_type(new_gear , i ni t i a l_gear ) ; 

/* if lever shift and still in gear, keep initial_gear */ 

if (((shift_init_type == MANUAL) && ( transmission jx)si t ion == IM^GEAR)) || 

(( automat ic_sip == 0) && (new_gear <= ini tial_gear)) || 

((dgos < SHIFT_INHIBIT_OECEL_LIMIT) && 
((transmission_posi tion == IN^GEAR) || 

((transmission_position == CXJT_OF_GEAR) && (shift_init_type « AUTO))))) 
new^gear = ini tial_gear; 
else 
i 

/* indicate gear change and adjust downshiftjxint */ 

automat ic^sip = +1; 

auto_up_of fset_rpm = 0; 

if (shift_init~type == AUTO) 

auto_dn2of fset^rpra = shf_tbl .dwn_t imer_of fset_rpm; 
else 

auto dn offset rpm = 0; 

> 

> 



if ((automatic sip (■ 1) && (initial gear > lowest forward)) 
i ~ 

/* initiate or continue an downshift: search down froa 

highe3t_forw»rd (slowest input speed) for the first available gear thet will 
provide'input speed above a value (approx downshift rpra, plus an offset for 
gears that will result in a net upshift) */ 
for (new^gear ■ tm_tbl .highest^forward; 

(new_Tnput_,speedTnew_gear) <*(downshif t_point ♦ 

(new_gear > initial_gear ? shf^tbl .dwn^of fset_rpra : shf_tbl .best^gr_of fset))) 
&& (new~gear > lowest_forward); 
—new^gear) 



if ((initial_gear =» 3) && ((new_gear "2) 1 1^ (new_gear a» 

new_gear = ini tial_gear; 
de8ired_gear_dn 3 new_gear; 

if (desired.gear^dn < ini tial.gear) /* Must be a down shift or else it coay */ 
desired_gear «~new_gear; ~ /* wrongly cancel the desired.^) pick. */ 



d»t«m1rw.tutosp(lt.typt<ntM,.9Mf*« initial jirar); 



/* if ltv«r shift vid stilt in gsv, Icscp inltisl gew* V 

if (((shiftjnit.type »» MANUAL) U <trsns«issionj»8ition " 1>I.CEA«>) || 

((sutomatic^sip »» 0) tt <neu_gear >« initial_gear)) || 

<(d90S < SHIFTJMHIBIT_0ECEL_LIMIT) && 
((transmissfon^sitiofJ « IM GEAR) || 

((transmission j»sition as OUT_OF_GEAR) && Cshift.im" retype == AUTO))))) 
ne«_9tsr a initial.gear; 
else ~ 
< 

/* indicate automatic gear change and adjust upshift .point */ 

autotnatic.sip a -i; 

auto_dn_o7fset_rpni = 0; 

if (shift_init~type »» AUTO) 

auto.up^of fset_rpra * shf_tbl -up_tiiner_offset_rpm; 
else 

auto up offset rpa a 0; 

> 

> 

return new gear; 

> 

fpra^na EJECT 



Faction: dtttmirw.destfrtttion 



* Description: 

* Thia function uses "coast ino_l etch" to determine if a coasting or 

* skip shift is beino atteopted. When sensed, the latch is used in 

* the determine_base ^ts fu^tion to affect the base shift points. 

void determine destination(void) 
< 

/* if coasting in neutral - modify shift points */ 

if (coasting latch »* FALSE) 
{ 

if ((last known gear - destination gear selected) > 1) /* multi downshift 
C " " 

if ((destination^gear^selected =» 7) 

(de8tination_gear_selected *« 5) 

(destination]]gear_selected » 3) 

(destination gear selected == 1)) 

< 

des t i na t i on^gea r_se I ec t ed++ ; 
coasting latch = TRUE; 

> 

> 

else 
i 

if ((destination gear selected - last known gear) > 1) /* multi upshift 

if ((destination_gcar_selected 10) 
(destination'gear^selected =» 8) 
(destination_ge8r_selected 6) 
(destination gear selected 4)) 

C 

dest i nat i on_gear_s elect ed- - ; 
coasting latch 3 TRUE; 

> 

> 

> 

else 

if (shift_in_process == FALSE) 
coast ing_l at ch « FALSE; 

> 

#pragma EJECT 



* Functions dtt«f«ine^aianu«l_»hift^« 
* 

• Description: 
* 

static void determine manual.shift ^ts(void) 
i 

if (coasting latch FALSE) 
< 

if << last_known_gear == 1) 
< last_knottn_gear »= 3) 
( last_known_gear 5) 
( last~lcnown~gear 7) 
( last^lcnoun_gear == 9)) 
auto_dn*rpm »"1325; /* annual downshifts */ 

else 

auto up rpm = U25; /* manual upshifts V 

> 



> 

#pragma EJECT 



* FuKtion: dtt»r«<n«_bw^ttuto.ihif t _ptt 
• 

* Owcription: 

* Th{a function dettrmints the base 14) and down shift points based on 

* the position of the throttle. These base points will be used in the 

* calculition of the upshiftjwint and the downshif tjxsint. 
* 

* The anti-hunting calculations have been moved to this function since 

* these calculations are now throttle dependent. 
• 

static void determine base auto shift _pts(void) 
i 

if (pet demand at cur sp > 0) 
< 

/* auto_up_rpra 3 shf_tbl .auto_up_io_base + 

((shf_tbl.aut_up_rpo - shf~tbr.auto_up_lo_base) * Xthrottle) • 

^cx s shf_tbl .aut_up_rpin - shf_tbl .auto_ip_lo_base; 
_bx « pct^d€mand_at_cur_sp; 
asm mulu "cxdx, ^^x; 
asm divu _cxdx, #100; 

auto^up_rpm » shf^tbl .auto_up_lo_base ♦ _cx; 

/* check for RTO requirement */ 
if <pct_demand_at_cur_sp > 90) 

auto3up_rpm"+=~shf3tbl .auto_rtd_of fset; 

/* auto_dn_rpm = shf_tbl .auto_dn_lo_base ♦ 

((shf_tbl.aut_dwn_rpm -~shf_tbl .auto_dn_lo_base) * Xthrottle) 

_cx = shf_tbl.aut_dwn_rpm - shf_tbl .auto_dn_lo_base; 
~bx = pet "demanded t_cur_sp; 
asm mulu _cxdx, _bx; 
asm divu _cxdx, #100; 

auto dn rpm 3 shf tbl.auto dn lo base + cx; 

> 

else 
< 

auto_up_rpm = shf^tbl .auto_up_lo_base; 
auto dn rpm a 'shf tbl.auto dn lo base; 

> 

determine_manual_shi f tjDtsO; 

if (shift in^rocess) 

/* reset ant ihunt_counter */ 
antihunt_counter = 0; 

/* allow the knob display to flashed any new desired gear */ 
flash desired allowed • TRUE; 

else 
i 

/* reset shift in process flags end update antihunt_counter V 

automat ic_3ip « Of^ 

if (antihunt counter < 255) 

i 

♦♦antihunt counter; 

> 

/* look for upshift ant i -hunt reset conditions */ 

if ((antihi^t counter ♦ (US PER LCBP/IOOO)) >= shf tbl.offset time) 

i ~ 

/• check for last shift a upshift effects */ 

if (auto_dn_of fset^rpm == shf^tbl .dwn_timer_offset^rpm) 

auto_dn_offset_rpn» = shf_tbl.dwn_of fset_rpm; 
else if"((auto_dn~offset_rp5 »= shf^tbl .dwn_of fset_rpm) && 

(input_speed_fTltered"> auto_dn_^rpra ♦ sh?_tbl .dwn_reset_rpm)) 
auto_dn^offset_rpro - 0; 

/* check for last shift » downshift effects V 
if (auto^ijp_of fset_rpBi shf^tbl.i4>_timer_offset_rpra) 
auto_up_off8et_rpa « shf_tbl .ip.offset^fpa; 



(input_fp««d_fTlttrtd > Moj4)jrpm • shf_tbl.i^_r«t*t.rpB)) 
auto^i^.of fMt^rpB « 0; 

/* allow the knob display to flashed tht desired gear V 

if (((desired.sear > destination^gear^selected) && (gos < (upshift jMint * 25))} || 
((deaired'gear < destination"gear~selected) && (gos > (downshift ^int - 25)))) 
f lash_desired_aUowed ■ FALSE;* 
else 

f lash^desi red_ailowed s TRUE; 



/* set the shift points based on throttle and determined offsets */ 
upshi f t^point = auto_up_rpra ♦ auto_up_of f set_rpni; 
downshi f t^point a auto_dn_rpro - auto_dn_of f set_rpra; 

/* check that the calculated shift point is reasonable */ 
if (upshif tjxjint > shf^tbl .man_dwn_sync_rpm) 
upsh i f t _po i nt = sh f _t b I . man^dwn^sync^r pro; 

if (downshiftjjoint < shf_tbl .man_up_sync_rpro) 
downshift^point = shf_tbl .raan_up_sync_rpni; 



#pragma EJECT 



Func t i on: se I •ct^gear 
Oetcriptfon: 

ThU it the root fuKtion for th« periodic task SELECT^GEAft. Each 
loop begins by dtecking the aenual cp/down buttons. Then, based on 
selected_inode end output theft speed, s *get_. .._gear* ftnction is 
celled to vjpdete destinet1an_geer_seiected. * 



void select gear(void) 
i 

char roanual^request; /* current manual request (♦/- 1) */ 

static uchar enable_gcw_calc; /* diagnostic - delete later II*/ 

enable_gcw_calc = FALSE; /* diagnostic - delete later II*/ 

shf^tbl 3 ini_shf_tbl; /* initialize the shift table */ 

de8tination_gear_selected = 1; 
desired_gear « ij 

/* initialize file scope variables */ 

wl » 3; 
w2 « 4; 
w3 » 5; 
w4 s 6; 

lpf_output_speed = output^speed; 

upshiftjjoint = shf^tbl .aut_up_rpm; 
downshi f t_point = shf_tbl .aut_dwn_rpm; 
auto_up_of fset^rpra = shf^tbl .up_tinjer_of fse terpen; 
auto dn offset rptn = shf tbl.dwn timer offset rpm; 
lowest Jorward~= INITIAL~START_GEAR; 
automat ic_sip » 0; 
antihwit_counter * 255U; 
coasting"latch » FALSE; 
flash_desired_allowed = TRUE; 

#if (0) /* shiftability variables */ 

zero speed counter s ZERO SPEED TIME LIMIT ♦ 5; /* force init of gcw variables */ 
eng_deccl_rate = -400; 7* RPm7sEC */ 

TRANS_STEP_SIZE_CAL ^ 3A6; /* 1.352 BIN 8 (was constant) */ 

torque accessories » lOO; /* accessory load with air condition off in coach */ 

gcw caT s 2400; /* (GCU x 1.68}/32.17 BIN 0 (was constant) */ 

gcw"cal_new = 2400; /* (GCW x 1.68)/32.17 BIN 0 (was constant) */ 

gcw_local » 45000; 

gcw_local^counter « 50; 

gcwJocaTtotal ■ 2250000; 

gross_coinbined_weight = 45000; 

#endif /* shiftability variables •/ 

X start j)eriodic(); 

while (1) 

< 

mda_output_filter()f /* update our filtered output speed ♦/ 

#if (0) /• shiftability */ 

if (enable gcw calc) /* diagnostic aid H*/ 
{ 

de t e rm i ne_g r oss_c oinb i ned^we i gh t ( > ; 
determine'shiftabi lity( )7 
determine'shiftability IK); 
> " 7* shiftability */ 

#endif 

fflanual_request » 0; 
determTne_base^auto_sh i f t^tsO ; 

/* set destination_gear_selected from fwtionO) appropriate for selected_mode */ 
switch(selected mode) 

i 

case REVERSE NODE: 



case DRIVE NODE: 



> 



ff ((fQjwd last » TIM) U 

(domlilTt dttcytd " FALSC) U 
(lou tpMd^latcli n FALSC)) 

{ 

de9tln»tion_9eftr_Mlcct«d « 9«t_auto(natic_gear<destination_gear_selected, manual^request) 
dettrmine <iitif»tion(); 

> 

break; 

case LOW^KOOE: 

case HOLD MODE: 

case NEUTRAL MODE: 

case PARK MODE: 

case POWER UP MODE: 

case POUER'oOUN KOOE: 

case OIAGNOSTiOeST_MOOE: 

/* prevent transient selection upon node change (these nodes ignore it) V 

destination^gear^selected « 0; 

break; 

default: 

/* invalid mode: do nothing */ 
break; 

> 

X sync _per iodic (US PER LOOP); 
x_end_per i odi c( ) ; 



• 

* Unpubllshtd «nd confidential. Not to b« reproduced, 

* disteninated, tranef erred or used without the prior 

* written consent of Eaton Corporation. 
* 

* Copyright Eaton Corporation, 1994. 

* All rights reserved. 



* Filename: trns_act.c96 (R-747) (AutoSplit) 

* ~ 

* Description: 

* This modules monitors and controls the transmission's actions. 
* 

* Part Nunber: <none> 
* 

* Rev 1.5 12 Dec 1994 09:19 markyvech 

* In "determine^gear** function; added condition for "intent^hold** and 

* "in_gear_switch". 

* " *" 

* Rev 1.4 9 Dec 1994 14:25 markyvech 

* In "determine_gear" function; added conditions that the "gear^in^timer" 

* will be held high while in the engine_sync_tnode and the intent_to_shif t 

* switch is depressed. (A smaller sync error is maintained for easier 

* lever engagement when the switch is depressed.) Also changed the offset 

* for clearing the low_speed_latch from downshif t_point + 100 to 

* downshi ft_point + 275. 
* 

* Rev 1.3 9 Dec 1994 07:59 markyvech 

* In "determine_spl i tter_state_autosplit" function; added the conditions 

* to preselect the splitter if"the "intent_to_shif t_swi tch" is TRUE. 

* — — — 

* Rev 1.2 7 Dec 1994 15:53 markyvech 

* Added the '*determine_range_state" function. Set the appropriate range 

* solenoid select f lag'based~on the electric range select switch. 
* 

* Rev 1.1 5 Dec 1994 14:54 markyvech . 

* Broke the "determine^spl i tter_state" function into multiple functions 

* based on the type of "base transmission system we are working with. 
* 

* Rev 1.0 3 May 1994 13:35:04 markyvech 

* Initial revision.- 
« 

* 

* Header files included, 
ft 

•*«***ft**«***««ft****ft«ft*******ft**ftftftftft**ft«ftftftftft**********ft*ftftftft«ftft*ft***ft*ftft/ 



#include <exec.h> 
#include <c_regs.h> 
#include <kr^sfr.h> 
#include <kr*def.h> 
#include <wwslib.h> 
#include "drl_ands,h" 
#include "trra^act .h» 
#include "trn tbl.h" 
#include »calc_spd,h" 
#include "cont~sy«.h*» 
#include "sel gear.h** 
#include »conTl939.h» 
#include "pr_s_i_s.h»' 

/ftftftftftftftftftftftftftftftftftft**. 
ft 

* Variables declared by this file, 
ft 

ftftftftftft*ftft**ft*ftftftft*ftftft**ftftft*ftftft*ft*ftft**ftft*ft***ftftftftftftftftft«*«*«ftftftft*ftftftftft****#«ft/ 

register unsigned char transmission_posi tion; 



/* executive information */ 

/* KR internal register definitions */ 

/* defines the kr special function registers */ 

/* 80c196kr bits, constants, and structures V 

/* engine control interface */ 
interface to this module V 
/• transmission table */ 



unsigned char R747_type; 

unsigned char jatiined_in_wrong_gear^timer,"- 

tmigned char manual^sync^delayed^^tiroer; 

unsigned char low_speed_latch; 

unsigned char forward^last; 



mlgntd clur 

unslgntd char 
trttigned char 
LTsigned char 
unsigned char 
unsigned char 
unsigned char 
signed char 
signed char 
signed char 
imigned int 
unsigned int 
msigned int 
unsigned int 
unsigned int 
signed int 
signed int 
signed int 
signed int 
signed int 
signed long 
signed long 
signed char 

#pragma EJECT 



spiitttr^hi; 

•plitterjo; 

ranga^hi; 

ranga.lo; 

splittar.tiBer; 

splittar_uithin_sync; 

aux^box; 

dotmsh i f t^de I ayed ; 

gj)tr_old; 

current_gear; 

last_knoyn_gtar; 

gear^in^tiawr; 

gear_out_ti(ner; 

no rma I _au t o_neu t r a I _ t i 

abs_trans_sync_error; 

t r ans_w i ndow_c a I c ; 

i nput_speed_tDodi f i ed; 

trans_sync_error; 

range_error; 

range_cal; 

spl i tter_tc; 

isdgf; 

gros; 

gjjtr; 



* fdaffnM constants local to this fils. 



#def int US PER LOOP 10000U 
#defin« JAMMEO^TIKE 200 



/* 2.0 SECOHOS */ 



c 
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mpragma EJECT 
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#pragma EJECT 



* Function: Ini titllM^Trans^Action 

* Description: 

* This function inltislizes those nodule variables that must be set to a 

* know state on power 14) or reset. 

void initialize trans action(void) 

gear_in_timer s 500; 

gear~out_tiiner » 500; 

g_ptr^old a 0; 

current_gear » 0; 

last_knowi_gear =0; 

destination_sear « 0; 

transmission ^position » OUT_OF_GEAR; 

low_speed_latch = TRUE; 

splitter_To "0; 

splitter~hi = 0; 

range^lo » 0; 

range^hi » 0; 

normal auto neutral^timer = 0; 
downshTft_dclayed ="falSE; 
manual_sync_delayed_timer = 0; 
jammed"] n wrong gear timer » JAMMED TIME; 
R747 type"- INTENT; " 

> 

#pragma EJECT 



* Ftrction: Check.For^Jaanwd.Gear 

* Description: 

* This function checks for a indicated engaged gear, (g_ptr), that is different 

* than "destination_gear_selected» and will force the needed conditions to 

* recover. This condition can occur when the transmission is "jaoined** into 

* the wrong lever position, (usually with the clutch disengaged), during a 

* shift. 
• 

void check_for_jamtned_gear(void) 



if (<shift_in _process == TRUE) && 
(automat ic_sip != 0) && 
(destination_gear_selected \^ g_ptr) && 
(g_ptr !» 0)"&& 

( janiDed_in_wrong_gear_timer > 0)) 
j anmed^i n_wrong_gear_tTiner - - ; 

if (janroed in wrong gear timer == 0) 
< 

shift_injjrocess = FALSE; 
automat ic^sip = 0; 
desired^gear = current_gear; 
destination^gear = current^gear; 
destination^gear^selected = current_gear; 
janmed in wrong gear timer = JAMMED_TIME; 
engine~coiTimands"= ENGINE RECOVERY; 

> 



#pragma EJECT 



* 

* Function: dcterroine^geap 
« 

* Description; 

* This function deterroines the current gear that the transmission 

* is in. When conditions are such that the current gear can not be 

* determined it will bm set to a default, (0). 
* 

* Mote: When the error across the transmission is near zero for some 

* time for a given test gear then it will be deemed in that gear. 
• 

* trans_sync_error = input_spd/gf [gear] • grCgear] * os 
void determine gear(void) 



#define BIN_8 


256 > 


2 BIN 8 


*/ 




#define MAx'err 


4000 y 


'* RPM 


*/ 




#define WINDOW 


30 > 


'* 30 RPM 


*/ 




#define GEAR IN TIME LEVER 


125 y 


'* 250 MSEC a 5 cnts per loop 


*/ 


HWefine GEAR"in TIME"aUTO 


50 > 


^* 100 MSEC a 5 cnts per loop 


*/ 


#define G£Ar"0UT TIME 


8 > 


'* 80 MSEC 


♦/ 




#define MANUAL SYNC DELAYED TIME 


45 y 


^* 450 MSEC 


♦/ 




#define ERROR ?UOGE*FACTOR 


3 > 


RPM 


*/ 




#define NORMAL.AUTOJIME 


250 > 


f* 2,5 SEC 


*/ 




#if (0) 











gjjtr = -1; /* lowest reverse ratio */ 

/** isdgf = input_speed_f 1 Itered / front box gear ratio *V 
_bx = (signed int)rinput speed_f i Itered); 
^cx = BIN_a; 

"ax = trn~tbl.GF[gj3tr ♦ GR^OFS] ; 
asm mul _cxdx, _bx; 
asm div _cxdx, _ax; 
isdgf = "cx; 

/** gros = output speed filtered * rear box ratio **/ 

_bx = (signed int)(output_speed_f i Itered ♦ ERROR_FUOGE_FACTOR); 

~cx = trn tbl,GR(g_ptr ♦ GR OFsf; 

^ax a BIN^S; 

asm mul _cxdx, _bx; 

asm div ^cxdx, "ax; 

gros = _cx; 

trans_sync_error = (isdgf - gros); 
if (isdgf > gros) 

abs_trans_sync_error = (unsigned int)( isdgf - gros); 
else 

abs trans sync error = (unsigned intXgros - isdgf); 

#endif 

abs_trans_sync_error = MAX_ERR; 
trans_window^calc = 0; 

if (abs trans sync error > trans window calc) /* if not in reverse, check for forward */ 
C " ~ " 

g j>t£ a 1 > trn_tbl .highest_forward; 

abs^Trans^sync^error » MAX^ERR; 

while (Cabs trwis sync error > trans window calc) && (gjdtr !a O)) 
{ 

gjDtr-; 

/** isdgf s input_speed^filtered / front box gear ratio *V 
bx 3 (signed int)( input speed filtered); 
^cx = BiM_8; 

"ax 5 trn^tbl.GFCg_ptr ♦ GR_OFS]; 
asm mul _cxdx, _bx; 
asm div _cxdx, _ax; 
isdgf s ~cx; " 

/** gros a output speed filtered * rear box ratio 

_bx » (signed int)(output_speed_f i Itered ♦ ERROR_FUOGE_FACTOR); 

"cx a trn tbl.GRCgj)tr ♦ GR^OFST; 

"ax « BIM^S; 

asm mul .cxdx, _bx; 

asm div ^cxdx, ^ax; 

gros » _cx; 



tpsns.sync^trror • itd^f • gros; 
if (iidgf > grot) 
ab«^trans_sync^error = (IntXisdgf • gros); 

ab$.trans_sync_erpor « (intXgros - isdgf); 

/* calculate trans sync error window based on gear pointer 



bx « UINOOU; 


/* 


BIN 0 */ 


jcx « BXHJ; 


/* 


SIN 8 */ 


^ax « trn^tbl.GFtg^ptr ♦ Gft^OFSJ; 


/• 


BIN 8 V 


asfli autu Icxdx, _bx; 


/• 


make WINDOW BIN 8 V 


asm divu _cxdx, ^ax; 


/* 


divide by front ration BIN 8 V 


trans_window_calc » _^cx; 


/* 


BIN 0 V 



if (g__ptr « 0) /* If in neutral, force values */ 

i 

ab«_tr8ns_sync_error = MAX^ERR; 
trans_sync_error = MAX_ERR; 
trans"window_calc = 0; 
isdgf « 0; 
gros 3 0; 

downshift_delayed » FALSE; 

jamroed in~wrong gear timer = JAMMED TIME; /* Initialize for next occurance •/ 

> 

if ((abs^trans_sync_error > trans_window_calc) || /* Must have error for seme V 
(<g_ptr !s current_gear) && (current_gear != 0))) /* before neutral state is */ 
( " " /* recognized. */ 

if (gear out timer == 0) 
C 

transmission_posi t ion = OUT_OF_GEAR; 
current gear = 0; 

> 

else 

gear out timer—; 

> 

else 

gear_out_ timer = GEAR_OUT_TIME; 



if ((gj5tr 1= gj3tr_old) || <g_ptr « O) || 

((intent_to_shift_switch == TRUE) && 
(in gear switch == FALSE) && 
(engine conmands ENGINE^SYNC) && 
(shift_Tnit_type == MANUAL)) || 

((accelerator^_pedal_position < 5) && 
(input speed < 700) &i 
(low speed latch FALSE))) 

i 

if ((engine conmands == ENGINE.SYNC) || 
(engine'comaands -* ENGINE'pREOIP)) 
i ' 

if (engine conmtnds «« EHGINC Pft£OIP) 

i 

normal_auto_neutra(_tia»r « Of 
manual'sync^delayed^tiawr » 0; 



else 

if (normal_auto^neutral_ti(aer <= NORMAL_AUTO_TlME) 
norma l_auto_neut ra l_,t imer** ; 

if ((shift_init_type == AUTO) && 

(normal auto neutral timer < NORMAL AUTO^TIME)) 
gear_in_ timer * GEAR_IN_TIME_AUTO; 
else 

gear^in^timer = GEARJN^TIME_LEVER; 



/* intent to shift stuff */ 



/* if not in gear, init gear in timer. 
/* Rule out picking a gear when coasting 
/* down in neutral and no throttle. 
/* (Found that idle speed and output speed 



*/ 
*/ 
*/ 



/* would match a gear even when in neutral.) */ 
/« Note: 700 should be idle^lOORPM V 



/* 
/* 
/* 
/* 
/* 
/• 
/* 



Use a short in gear time 
for splitter only shifts 
unless the system has been 
in neutral too long, 
EX: When driver pulls the 
lever to neutral during a 
splitter only shift. 



*/ 
•/ 
•/ 
*/ 
*/ 
•/ 
*/ 



else 

if (gear in timer sa Q) 
i 

current^gear « g_ptr; 



trvwBlssion ..posfticn • li.QM; 

nonBal_«uto^ntutr»l_ti«tf ■ 0; /* 9«t ready for next tim */ 
downshlft^detayed ■ FALS; 

if ({intent_to,shift_«ttftch » TRUE) && (engine_co(iinands ENGIME^SYNC)) 
intent^hoTd ■ TRU€; 

if (Cgos current gear > (downshiftjxint ♦ 275)) && 
(low'speed latch » TRU£)) 

{ 

low_speed_latch * FALSE; 

destinat ion_9ear = current_ge8r; 

destinat ion^gear^selected ■ current^gear; 

desired^gear = current_gear; 

lowest forward » current gear; 
> " 
else 
C 

if (low speed latch == TRUE) 
C " 

destination_gear = louest^forward; /* was set to 1 */ 

destination_gear_selected « lowest_forward; /* was set to 1 */ 
desired^gear = I owes t_ forward; ~ /* was set to 1 */ 

shift i Reprocess = FALSE; 

> 



if (last_known_gear > 0) /* Record REV/FOR data for */ 

forward_last~= TRUE; /* use in the select^gear */ 

else ~ /* module. */ 

forward last = FALSE; 

> 

else 
i 

if ((((shift init type == AUTO) || ( low_speed_latch == TRUE) || 
(fnanual_sync_delayed_timer >= MANUAL_SYMC_OELAYED_TIME))) && 
(gear_in_ timer >= 4)) 
gear_in_t imer •= 4; 

if (gear_in_timer > 0) 
gear_in_timer--; 

if (destination_gear_selected gj>tr) /* Prevent splitter shift while */ 
downshift_delayed s TRUE; /* still confirming a lever shift. V 



> 



check_for_jarnned_gear( ); 
g_ptr_old = gj3tr ; 

if (((engine coomands == ENGINE SYNC) || 

(engine^commands » ENGINE^FOLLOUER)) && 
(manual^sync^delayed^timer < MANUAL_SYNC^DELAYEO_TIME)) 
manua l_sync_deTayed_t i mer** ; 



/* manual_sync_delayed_timer is used to allow the sync 
/* inode*s~f irst pass a'chance to pass the engine speed 
/* thru sync and give the mechanicals a chance to 
/* transition. At this time a falsa in.gear signal 
/* should be avoided. */ 



if (output speed filtered < 125> If stopped; set low speed latch V 

< 

current^gear a o ; 

transmission ..position « OUT_0>.GCAJl; 
low^speed.latch « TRUE; 

if (splitter launch state » LO SPLITTER) 
< 

if ((lowest_forward ss 2) 11 
(lowest^forward 4) || 
(lowest_forward =« 6)) 
lowest forward--; 

> 

else 
{ 

if ((lowest_forward =» 1) || 
(lowest_forward 3) || 
(lowest^forvard «■ 5)) 
lowest forward^; 

> 



Iprbflon EJECT 




Ftnction: detenoinc_range_status 
Description: 

This function determines the status the of range. 
rng_err = rear_counter_spd - (range_ratio * output^spd) 
res = 54/21 * 44 * OS (for low range) 
res = 42/51 * 44 * OS (for high range) 



void determine range status(void) 
< 

#define BIN 12 4096 /* 2 bin 12 •/ 

#define HI RANGE GEAR 7 

#define LO"RANGE"cal 10532 /* 54/21 BIN 12 */ 

#define hTrance'cal 3373 /* 42/51 BIN 12 */ 

#define RANGE UINDOU POS 30 /* 30 RPM */ 

#define RANGE"uINDOw"nEG -30 /* -30 RPM */ 



/*** This code was never tested or used during the concept development ***/ 
/*** phase. However, it is likely to be needed for range protection ***/ 
/*** in the product. ***/ 

if (destination gear HI RANGE GEAR) 

range_cal = h7_RANGE_CAl7 
else 

range_cal = LO_RANGE_CAL; 

range_error =(((aux_speed * BIN_12) 

- (range^cal * output_speed_f i ltered))/BINJ2); 
if ((range error > RANGE UINOOU POS) || (range error < RANGE UINDOU NEG)) 

aux^box = 0UT_0F_GEAR;~ 
else 

aux_box = IN_GEAR; 



#pragma EJECT 



* Function: detenoint.range.statt 
* 

* Description: 

* This fixtction determines the correct state for the range, 
void determine range state(void) 



if (range_setect_switch == HIGH) 



range^lo 
range hi 

> 

else 
C 

range_lo 
range hi 

> 



OFF; 
ON; 



ON; 
OFF; 



/* Turn off the low range solenoid V 
/* Turn on the high range solenoid */ 



/* Turn on the low range solenoid V 
/* Turn off the high range solenoid */ 



> 



#pragma EJECT 



♦ 

* FuKtion: d»termfnt.3plitter_statt.autosplit 

* * 

* Oe«cpiptfon: 

* This function determines the correct state for the splitter. 

* Once the transmission Is in gear both splitter solenoids are turned off, 

void determine splitter state autosplit(void) 
< 

#define SPLTR SYMC OFFSET POS 80 /* 80 RPM •/ 
•define SPLTR SYNC OFFSET"mEG -80 /• -80 RPM V 
#definc SPLITTER^tThE " 20 /* 200 MSEC V 

if (engine_st8tus == ENGINE_PREDIP_MOOE) /• The spl i tter_timer will keep the 

splitter^timer a SPLITTER^TIME; ~ /* solenoids on""for a short time 

else ~ " /* once the SYHC mode is entered, 

if (splitter_timer > 0) /* This allows the splitter enough 

spl itter_tTraer--; /* time to move, (i.e., uhen the 

/* splitter changes during SYMC. 

splitter^tc = SPLITTER_TC_TABLE tdest ination^gear + GR_0FS1; 

input_speed_modi f led = (signed int)( input_speed_f i Itered) ♦ 

(input_speed_accel_f i Itered/dOOO/splitter^tc)); 

if ((input speed modified < (gos signed + SPLTR SYNC OFFSET POS)) && 
(input^speed^modif ied > (gos^signed ♦ SPLTr2synC_0FFSET^NEG))) 
splitter_wi thin_sync = TRUE; 
else 

splitter^wi thin^sync = FALSE; 

if ((intent_to_shift_switch « TRUE) && /* Allows for pre-selection */ 

(desi red^gear !="destination_gear^s elected) && /* of the splitter. */ 

(intent^hold FALSE) ~ * 

(automatic sip == 0) && 
(shift_init_type == MANUAL) && 
(transiiiission^posi tion == IN GEAR)) 

{ 

splitter^hi = SPLITTER^HI^TABLE (desired^gear * GR^OFS); 
splitter"lo = SPLITTER^LO^TABLE [desired"gear ♦ GR"oFS]; 
> " 

else /* "Normal" splitter control •/ 

i 

if ((splitter_timer > 0) | | 

((transmission__posi tion IN_GEAR) && 
(shift_inj)rocess == FALSE))"|| 

(low_speed_latch « TRUE) || 

(engine.status " ENGINEJECOVERY_MC]OE) || 

((shift init type » MANUAL) U 
(engine.statua «« ENGINE.SYMC.MOOE)) || 

((shift init type » AUTO> U 
(engine^status «« EUGIME.SYNC.MOOE) && 
(splitter within sync «"truE))) 

< 

splitter hi = SPLITTER HI TABLE [destination gear * GR OFS]; 
splitter lo - SPLITTER LO TABLE [destination gear ♦ GR OFS]; 
> " 

else 
( 

splitter^hi = OFF; 
splitter"lo « OFF; 

> 

> 

> 

tpragma EJECT 



* 

• Function: d«teralne_tp(ittcr_9tate_dual_forc« 

• Description? 

• This function dtttraines th« correct state for the splitter. 
* 

void determine splitter state dual force<void) 
i 

if <(clutch_state — DISENGAGED) || /* use normal forces */ 

(desired gear > 6)) 

i 

splitter_lo = ON; 

> 

else 
C 

if (splitter_select_switch == HIGH) /* use high force into overdrive 

splittcr_lo « OFF; 
else 

spl i tter lo » oN; 

> 

if (sptitter_select_switch == HIGH) 

splitter_hT = ON;" 
else 

splitter_hi = OFF; 



fpragma EJECT 



* Ftfxtion: d»teniin«_»pUttep_3tat»^base 

* * 

* Description: 

* This function dctennines the correct state for the splitter. 
• 

void determine splitter state base(void) 
i 

splitter^lo = ON; 

if (splitter_select_switch == HIGH) 

splitter^hT = ON;" 
else 

spl itter^hi s OFF; 

> 

#pragma EJECT 



* 

* Finctioo: d€tertnine_splitter^3tate 
* 

* Description: 

* This fi*Ktion determines the correct state for the splitter. 
• 

void determine splitter stateCvoid) 
{ 

if <R7A7_type == 8ASE) 
determine_spl i t ter_state_base( ) ; 

else 

if (R747_type == DUAL_FORCE) 
determine_spl i tter_state_dual_force(); 

else 

determine splitter state_autosplit(); 

> 



#pra9na EJECT 



* FuKtion: Transaission^Action 

* Description: 

* This fvTkction controit th« states of the system ouput devices. 



void transfflission act ion( void) 
initiaU2e_trans_action(); 



/* initialize variables */ 



X start jjeriodicO; 

while <1) 

i 

determine^gearO; 

de t e rra i nc* r ang e_s t a t us ( ) ; 

deterraine_range"state(); 

determine^spl itter^stateO; 

x^sync jjer i odi c (US.PER^LOOP ) ; 



/* calculate the current gear */ 

/* determine range state */ 

/* determine correct state for range */ 

/* determine correct state for splitter */ 



x_endj>eriodic(); 



Files from C:\R0N\R747\INTENT\INTENT.ZIP 



9 



DRL_CMDS.C96 
PR_S_I_S.C96 
SEL_GEAR.C96 
SEQ_SHFT.C96 
TRNS ACT.C96 



12/09/94 
12/12/94 
12/12/94 
12/12/94 
12/12/94 
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disscainatad, transferred or used without the prior 
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Copyright Eaton Corporation, 1993-94. 
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Filenane: drl_cmds.c96 <R-747) (AutoSplit) 
Description: 

The functions in this file will perforoi the required operations 

for controlling drivel ine components on the J 1939 coonunication link. 

Part Ntnber: <none> 

Rev 1.4 09 Dec 1994 14:29 oarkyvech 
In function "control_engine_sync**; added code to allow aaaller sync 
offsets if the intent to shift switch is depressed. This allows easier 
shift lever insertion. (Note: the gear cannot be confirsad until the 
switch is released.) 

Rev 1.3 09 Dec 1994 11:18 markyvech 
In function "control^engine _j)redip"; added code to allow recovery oode if 
the intent switch is^released before neutral is achieved. Also added the 
pr_s_i_s.h to get the intent_to_shif t_swi tch variable. Also added a faster 
torque ranp off rate for manual intent to shifts 

Rev 1.2 08 Dec 1994 14:44 markyvech 
Changed the offsets in "control_engine_sync" from +-65 to ♦-45 RPM. Also 
changed the input speed filter constant, (IS_FIC1), from 236 to 235. 

Rev 1.1 07 Dec 1994 15:33 markyvech 
Took out the rear counter shaft speed substitution for output shaft speed 
because there is no rear counter shaft speed sensor. 

Rev 1.0 14 Sep 1994 10:48:40 markyvech 
Initial revision. 



* 

* Header files included. 
* 

#include <exec.h> /* executive information */ 

#include <c_regs.h> /* ICS internal register definitions V 

#include <wwslib.h> /* contains cooinon global defines V 

# include "cont_sys.h" /* control system information •/ 

#include "conj1939.h** /* defines interface to j1939 control module V 

tinclude "drl_cmds.h* /* drivel ins coomands information */ 

#include "trn_tbl.h** /* transaission table data structures V 

#include "sel~gear.h* /* access to speed filter values V 

#include **calc spd.h" 

#include "trnslact.h" 

#include "pr_s_i_s.h*' 



#pragma noreentrant 



* #defines local to this file. 
* 

#define US_PER_LOOP 10000U 

#define ACTIVE_RECOVERY_GEAR 10 /* rule out boosting downs for now V 



* Constants and variables declared by this file. 



/• public •/ 



resist er iMigned chtr cnQine^cc 

regUter unsigned chsr engine^statut; 

unsigned char desired^sync^test^iaode; 

insigned char forced^predip; 

unsigned int desired_engine_speed_test; 

unsigned int desired^engine^speed^raqp; 

unsigned char de3ired*engine~speed*tiaer; 

ireigned char desired_engine_speed_tiiDe; 

unsigned char eng^brake^caanind; 

unsigned char eng"brake*assist; 

unsigned char posTtive_pedal_trans; 

unsigned char sync_f irst_pass_tifDer; 

/* unsigned char cTutch^stateJ */ 

unsigned int clutch_sl ip_speed; 

signed int dos^f iTtered; 

signed int overaU_error; 

unsigned int os.based^on^rcs; 

unsigned int input_speed^fi I teredo- 
signed int dgos;~ 

signed int input_speed_accel_f i Itered; 

unsigned int output_speed_f i Itered; 

unsigned long is_f i ltered_bin8; 

unsigned long os~f i ltered"bin8; 

signed long dis_f i I tered_bin8; 

signed char eng_percent_torque_f i I tered; 

signed char pe rc en t_torque_acces scries ; 

signed char needed_percent_for_2ero_f lywheel^trq; 
unsigned char 2ero_f lywheel_trq_timer7 
unsigned char zero_f lywheel^trq^tiinej- 
unsigned char accererator_pedal_position_old; 

unsigned int gos; /* overall destination gear ratio * output speed BIN 0 V 

signed int gos^signed; /* overall destination gear ratio * output speed BIN 0 */ 

signed int input_shaf t_accel_calculated; 

unsigned int gos_current_gear; /* overall current gear ratio * output speed BIN 0 */ 

unsigned char sync^f irst_pass; 

unsigned int sync_maintain_timer; 

signed int sync^offset; 

signed int sync^offset _pos; 

signed int sync^of f set_neg; 

signed int sync"dos_offset; 

signed int sync_dos_offset_IC1; 

signed int sync~speed_modified; 



/* local V 




static 


unsigned 


int 


static 


cvisigned 


char 


static 


unsigned 


char 


static 


signed 


char 


static 


irtsigned 


char 


static 


unsigned 


int 


static 


unsigned 


int 


static 


unsigned 


char 


static 


unsigned 


int 


static 


unsigned 


char 


static 


unsigned 


int 


static 


unsigned 


int 


static 


signed 


int 



predip_ti(Der_1; 
predip^timer^Z; 
predip^tfawO; 
prtdlpTtorque^buip.value; 
prcdf p_torqut*biJBp~t ine; 

sync^on.titBer; 
sync3off_ti»»r; 
sync^di ther^t \wmt\ 

torque_lioit; 

r ecovery_cance l_t i oer ; 

recov_coast_down_tmp1 ; 

recov|[coast"down"tinp2; 

lpf_output_accel; 



ipragroa EJECT 



PR£D1P MGOe CQNSTAKTS 



Meffne PREOIP ZERO FD8S TI)€ 
Mefine PREOIP TQROUE ZERO TINE 
«def1nt PREDIP NORMAL~TIMC~ 
idefine TOftQUE_RAMP_0?F_aATE 

idefine PREDIP TORQ BUMP VALUE LO 
«d»fine PR£DIP_TORQ_BUHPItIME_LO 

idefine PREOIP TORQ BUMP VALUE HEO 
Idefine PREOIpItoRq'bump^TIHE.HEO 

#define PREDIP TORQ BUMP VALUE HI 
#define PREDIpItORQ^BUKPJIME^HI 



40 


/* 


0.408 aiOias period 


*/ 


60 


/* 


0.60s aiOos period 


*/ 


200 


/* 


2.009 aiOois period 


*/ 


1 


/* 


IX (per loop) V 




0 


/• 


OX */ 




15 


/* 


O.ISs aiOns period 


*/ 


10 


/* 


10X V 




25 


/* 


0.258 aiOoB period 


*/ 


25 


/* 


25X */ 




30 


/* 


0.308 aiOms period 


*/ 



SYNC MODE CONSTANTS 



#def ine 


sync.dither time above 


20 


/* 


0.20s aiOms period 


*/ 


idefine 


SYNC"0 I THER"t I ME~BEL0W 


30 


/* 


0.30s aiOoB period 


*/ 


idefine 


sync"dither"rpm * 


35 


/* 


35 rpn 


*/ 


idefine 


sync_dither~first_time 


255 


/* 


DUMMY VALUE 


*/ 


idefine 


maintain sync time 


500 


/• 


5.00 Sec 


*/ 


idefine 


sync first pass time 


250 


/* 


2.50 Sec 


*/ 


idefine 


THREE percent 


3 








idefine 


ENG RESPONSE UPSHF TIME 


10 


/* 


10 msec 


*/ 


idefine 


ehg"response"dnshf"time 


10 


/* 


10 msec 


*/ 


idefine 


SYNC DOS OFFSET CCSSTANT 


2816 


/* 


11 BIN 8 


V 



RECOVERY MODE CONSTANTS 



idefine RECOVERY CANCEL TIME 10 /• 0.10s aiOss period */ 

idefine RECOVERY CANCEL OFFSET 20 /• 20X BIN 0 •/ 

idefine RECOVERY TORQUE STEP 1280 /* 5X BIN 8 V 
idefine THLO 0S_ENG DECAY K1 450 

idefine THLO OS ENG'oECAY*RAMP 1 /* 1 rpra BIN 0 */ 

idefine THLO"ds"fInTshEO DELTA 200 /* 200 rpn BIN 0 •/ 



static const uint RECOVERY RATE TABLE (23} » 



0, 


/* 


-4 


*/ 






0, 

128, 


/* 


-3 


*/ 






/* 


-2 


: O.SOX per 


loop 


Bli 8 V 


128, 


/* 


-1 


: 0,50X p«r 


loop 


Bir • V 


128, 


/• 


0 


: O«509( per 


loop 


BtN 8 V 


128, 


/* 


1 


: 0.5(K pm 


loop 


BIN 5 V 


128, 


/* 


2 


: 0.5COI per 


loop 


ftIM i V 


128, 


/* 


3 


: 0.5QX per 


loop 


•IN 8 V 


128, 


/* 


4 


: 0.50X per 


loop 
loop 


BIN • V 


192, 


/* 


5 


: 0.75X per 


BIN 8 V 


192, 


/• 


6 


: 0.75X per 


loop 


BIN 8 V 


192, 


/• 


7 


: 0.75X per 


loop 


BIN 8 V 


281, 


/* 


8 


: 1.10X per 


loop 


BIN 8 V 


281, 


/* 


9 


: 1.10X per 


loop 


BIN 8 V 


281, 


/• 


10 


: 1.10X per 


loop 


BIN 8 V 


0, 


/♦ 


11 


•/ 






0, 


/* 


12 


*/ 






0, 


/• 


13 


•/ 






0, 


/* 


14 


•/ 






0, 


/* 


15 


*/ 






0, 


/• 


16 


*/ 






0, 


/* 


17 


♦/ 






0 


/• 


18 


V 







>; 



* F«t1on* initUli2«.<lrlv«Hn»_dit« 



* 



* Description: 

* This finction, called after all resets, will initialize the system 

* copy of drivel Irtt related data received from the cocimuni cat ions link. 



static void initialize drivtline_data(void) 
< 

accelerator_pedal_position « 0; 
enfline_coflinunication_active « FALSE; 
engine^brake^availabTe ■ FALSE; 

eng brake coraoand * ENG BRAJCE IDLE; /* should init with engina c 
/* cTutch_8tate a EMGACED; */ 
poaitive2p«dal_trans » FALSE; 
zero_f lywhecl_trq_tioer « 0; 
zero"f lywheel_trq_tin»e ■ 0; 
percent.torque_accessorie« « 3; 

desired_sync_test_mode = FALSE; /* debug use only - delete later */ 
desired_engine_speed_test » 0 ; /* debug use only - delete later */ 
desired^engine'speed'ranp = 0 ; /* debug use only - delete later V 
desired_engine_speed_timer = 0; /* debug use only - delete later V 
desired engine_speed > 0; 

sync_dos_offset_ICl = SYMC_0OS_0FFSET_CONSTAIIT; 
desired_engine_speed_time ■ 0; 
forced _predip = FALSE; 



ipragma EJECT 



Function: control.engfrw ^edlp 



* Oescriptfon: 

* D«tftraiines throttlt coanand for predip (node. 

* After a reasonable delay for the transmission to pull to neutral the 

* torque will be cycled froa zero to a determined value to help the 

* transmission achieve neutral. 

*********«****************«**«*«*******«*******«**«*************«**«***«^ 

static void control engine ^redip<void) 

If (engine status l» ENGINE PREOIP MODE) 
< 

engine_status > ENGINE_PRE01P_HG0E; 

predip^tiiner_1 a O; 
predip*ti(aer~2 » 0; 
predip^timer_3 » 0; 

if ((actual engine^t trq < 5) || (forced_predip timer > 0)) 
predip_tTmer_1 a PREDIP_HO«MAL_TIME; 

else 

desired engine_pct trq = actual enginejxt trq; 

> 

engine control = TORQUE CXJNTROL; 
conmand.ETCI = C_ETC1_OVERSPEE0; 



if ((intent_to_shift_switch TRUE)) /* Allows for recovery mode if the "intent" switch V 
posit ive_pedal_tra?U a TRUE; /* is released before neutral is achieved V 



if (predip timer 1 < PREOIP NORMAL TIME) 
i 

if ((desired_enginejxt_trq >■ TORQUE_RAMP_OFF_RATE) && 
(actual engine__pct trq > 0)) 

{ 

d€sired_enginejxt_trq TbROUE_RAMP_OFF_RATE; 

if ((intent to shift switch « TRUE) U /* fatter rate for intent to shift V 
(shiftjnit^type"== MANUAL) && 
(actuaT_engine_pct_trq > 0)) 
desired engine _pct trq -» 1; 

> 

else 
{ 

desired^engine j)Ct_trq = 0; 

/* check to force bump if neutral not achieved •/ 
if (actual engine _pct trq < 10) 
< ~ " 

if (-Mpredip timer 3 >« PREDIP ZERO FDBK TI»C) 
predip tiiatr 1 > PREOIP NORMAL tT^C; ~ 

> 

> 

♦♦predip timer 1; 

> 

else 
< 

if (((Ipf output accel > -150) || (forcedj>redip timer > 0)) && 

(predip timer'l < (PREOIP NORMAL TIME ♦ PREOIP TORQUE ZERO TIME))) 

i 

predip_torque_buip_time ■ PREDIP_TORQ_BUMP TIME_LO; 

predip torque'buip'value « PREDIP TORQ BUMP VALUE LO ♦ needed_percent for zero flywheel trq; 

> 

else 
i 

if (predip timer 1 < (PREDIP NORMAL TI»£ ♦ 2*PRE0IP TORQUE ZERO TIME)) 
predip_torque_bunp_time = PRE0IPJ0RO_BUMP_TIME_MED; 

predip torque bunp value » PREDIP TORQ BUMP VALUE MED > needed^rctnt for zero flywheel trq; 

> 

else 



grmiip^torqmjumj^im ■ PtaiPjan.0UI9.TlMC HI; 

pr«dfp_tor^.bup.v»lu» « PftCDI^.TOKa^SUMP VALUE tit ♦ nMdtd^pm-ccnt for z*ro fly^Ml trq; 
> ' - - . - 

if (pr«dfp tiaer 2 < pr«dip torqut batp tiioe) 
C 

if (actual engint^ct trq > 0) ~ 

C 

♦♦predipjiner^l; 
♦♦pr ed i p* t i iner"2 ; 

> 

> 

•Ist 

< 

desired.engine _pct_tpq » 0; 

♦>predipji«tp_1; 

♦+pred \ p"t i n»ep~2 ; 

> 

if (predip.tiiner.2 >» PREDIPJOROUE.ZERO_TIME) 
predip timer 2 » 0; * * ~ 

> 

^pragma EJECT 



* FiKtioru contrei.enoirw^tync (AutoSplit) 

* " 

* D#«cription: 

* This fuxtion synchronizes engins speed to output shaft speed 

* during a shift. 

Static void control engine sync(void) 
i 

if ((intent_to_shift_switch " TRU€) && /* Intent to shift conditions •/ 
(shift Tnit type~-3 MAMUAl)) /* that allou lower offsets. */ 

i 

sync_offset _pos ■ 20; 
sync~offset neg « -20; 

else 

sync_offset_pos ■ 45; /* normal AutoSplit offsets */ 

sync~off8et neg » -45; 
> " ~ 

if (accelerator j>edal_position > THREE PERCENT) 
sync_inaintain_timer = MAINTAIN_SYNC.TIME; 

if ((engine status != ENGINE SYNC MODE) || (sync maintain timer « 0)) 

sync_on_timer = 0; 
sync^of f _ t i me r ■ 0 ; 
sync"f irst JMSS = TRUE; 

sync2first_pass_timer = SYNCJIRST_PASS_TIME; 

if ((shift^type « UPSHIFT) && (shif t_init_type « AUTO)) 

sync_offset * sync^of fset_neg; 
else 

sync_offset = sync_offset _pos; 

if (engine status != ENGINE SYNC MODE) /* first time through sync */ 

engine^status = ENGINE_SYNC_MOOE; 

if (forced_predip == FALSE) 
sync maintain timer « MAINTAIN SYNC TIME; 

> 

else /* sync maintain timer reached 0 */ 

i 

engine control » OVERRIDE DISABLED; 
conrand ETC1 « C ETC1 NORMAL; 

> 

> 

else 

i 

sync^ma i nta i n_t i ner • - ; 

if (sync on tiotr^ o 200) /* allow sync mode for about 2 seconds V 

sync_off^timer « Or 

engine control > SPEED CONTROL; 

co(iro8nd_ETC1 « C_ETC1.0VERSPEEO; 

if (sync firstjjass »» TRL€) 
i 

if ((shift type » UPSHIFT) U (shift init type » AUTO)) 
{ " 

sync speed modified s (signed int)( input speed) ♦ 

(irvut.speed.acceljiltered /(1000/ENG_RESPONSE_UPSHFJIME)) 

if (sync speed modified < gos signed) 

if (sync first_pass tiwr «» 0) 

sync^offset « sync_offset _pos; 
sync*f irst jmss » FALSE; 

> 

els« 



sync first ^pass^tfaer--; 

> 

> 

else /* shift is a downshift */ 

{ 

sync speed ncxiified ■ (signed int)( input speed) * 

(input.speed.acceCfiltered /(1000/£NG_RESP<»ISE_OMSHf JIHE)); 

if (sync speed modified > gos signed) 
C " ' 

/* if (sync first _pass timer == 0) */ 
/* < " */ 
sync first_pass = FALSE; 

if (?pct_demand_at_cur_sp < 15) || (shif t_init_type »= MANUAL)) 
sync offset « sync offset neg; 
/* > ' */ 
/* else */ 
/* sync first_pass timer--; */ 
> 

> 

if (gos_signed ♦ sync^offset > 0) 

desired^engine^speed = ( int)(gos_signed ♦ sync_offset); J 
else 

desired_engine_speed = 0; 

> 

else 
i 

if (sync^of f^timer <= 4) 
sync_of f _t 1 mer++ ; 

else 
i 

sync_on_timer = 0; 

if (shift_init_type == AUTO) 
sync^offset = -(sync_of fset); /* force sync speed to toggle around gos V 

else 
i 

sync first_pass = TRUE; 

syncjirstj3ass_timer = SYN(:_FIRST_PASS_TIME; 
sync~offset = sync_of fset^pos; 

manual sync delayed timer = 0; /* used in SEQ SHFT.C96 module */ 
> " " " 

> 

> 

) 

> 

ipragma EJECT 



Ptretion: cQntrol_tng1n«_sync_tett_Bod* (AutoSplit) 
Description: 

This ftnction test the synchronize node of engine speed control. 



static void control engine sync test (aode<void) 
i 

if (accelerator_pedal^si tion < 10) 
< 

engine_3tatus ^ £NGINE_FOl.LOUER_MGOE; 
engine'conntands » ENGINE FOLLOUER; 
engine'control « OVERRIDE DISABLED; 
coBwand.ETCI » C_ETC1_N0RKAL; 
desired'engine speed > 0; 

> 

else 

i 

if (accelerator^pedal^position > 90) 
< 

engine^status » ENGINE_SYNC_M0OE; 
engine^coomands = ENGINE^SYNC; 
engine"control = SPEED CONTROL; 
commandJTCl » C_£TC1_0VERSPEE0; 
desired*engine_speed s desired_engine_speed_test; 
desired engine speed timer » desired engine speed tinie; 

> 

else 
< 

if (desired_engine_speed_ti(Der > 0) 

des i red_eng i ne_speed_t i ner - - ; 
else 
{ 

if (desired engine speed > 600) 
{ 

des i r ed_eng i ne_speed_ t i mer s des i r ed_eng i ne_speed_t i me ; 
desired'engine^'speed » (desired engine speed - desired engine speed ramp) 

> 

> 

> 

> 

^pragma EJECT 



* Function: dttenDine.if^r«covery_^canpl«te 

* Description: 

* This routine checks to see if the percent_torque_value_l irait has 

* exceeded the percental orque^veiue feedback from the engine by xX 

* for X Billiseconds and will then set percent_torque_value_liinit 

* to 100X to cancel the recovery node. 

♦*♦*«♦♦♦♦****♦**«*•*****★******♦*♦***#*♦♦**♦*******•**********♦*♦*******/ 

static void determine if recovery conplete(void) 
< 

if ((net engine jxt trq > 10) && 

(desired engine_pct trq > (net engine jxt trq ♦ RECOVERY CAMCEt OFFSET))) 
< " " " " 

"M-recovery cancel timer; 

else 

recovery_cancel_timer = 0; 

if ( (recovery_cancel_tiner >« RECOVERY_CAMCEL_TIHE) || 
(desired engine^t trq » 100) ) 

/* terminate the recovery mode */ 

desired engine _pct trq » 100; 

engine status = ENGINE RECOVERY MXE COMPLETE; 

> 

#pragma EJECT 



* Fwtiom control.tn9in».Pteov«ry_nor«Bl 

* 0«tcr1ption: 

* Oettnnine throttl* cosnsnd for recovtry mode. 

* TORQim.LlMIT is tcaltd as • BIM 8 nuiter representing the percentage 

* of torque allowed to the engine during recovery. 

static void control engine recovery normal (void) 
< 

engine control = SPEED TORQUE LIMIT; 
ccBinand_ETC1 « C_ETC1_N0RMAL; 

desired^engine^speed = 8031; /* torque Unit only, max value for speed */ 
torque.limit RECOVER Y_RATE_T ABLE Cdestination_gear^4) ; /* BIN 8 V 
desired^enginejxt^trq « <char)(torque_liiait » 8); /* BIN 0 •/ 
determine if recovery completeC); 

> 

fpragna EJECT 



Description: 

Dtttraine throttlt coonnd for coasting doun shifts node. 



static void control engine recovery coast ing( void) 

register uint loca(_uint; 

if (sync on timer <= 300) 
i 

-M-sync_on_t imer; 

engine control = SPEED COMTROL; 
cooinand^ETCI « CJTC1_M0RMAL; 

sync_of f^timer = 0; 

/*♦ recov_coast_do«n_tinp1 » gos + (dgoa • Kl) - THLO_OS_ENG_DECAY_RA«P **/ 

if (dgos < 0) /* get absolute value */ 

_cx = (uint)*dgos; 
else 

_cx = (uint)dgos; 

asm oulu cxdx, #THL0 OS ENG DECAY K1; /* BIN 12 */ 

asm shrl "cxdx. #12; " " " " /* BIM 0 V 

if (_cxdx > 500) /* error check */ 

local_uint = 0; 
else 

local_uint = _cx; 

if (Ipf output accel > 0) 

recov_coast3do«n_tmp1 « (gos ♦ local_uint) - THL0_DS_EMG_DECAY_RAf4P; 
else 

recov^coast_doun_tmp1 » (gos - local_uint) - THLO_DSJNG_OECAY_RA«P; 

/** recov_coast_down_trnp2 ■ desired_engine_speed - THLO_DS_ENG_DECAY_RA>V 

recov_coast_down_tmp2 » desired_engine_speed - THL0_DS_EM6_0ECAY_RAMP; 

if (recov_coa3t_down_tmp1 < recov_coast_down_tmp2) 

desired_engine_speed = recov_coast_down_tmp1; 
else 

desired engine speed = recov coast down tmp2; 

> " " " " " , 
else 

< 

if (sync off timer <= 5) 
{ 

♦♦sync off timer; 

engine'controt « TORQUE COimot; 

cooinand_ETC1 • C.ETCl.KOWAt^ 

desired'engine jxt trq « 0; 
> " * 

else 

sync on timer • 0; 

> 

if ((desired engine speed * THLO DS FINISHED DELTA) < gos) 
i 

/* terminate the recovery mode */ 

desired engine_pct trq « 100; 

engine status » ENGINE RECOVERY NODE COMPLETE; 

> " 

> 

«pragma EJECT 



Func t i on : cont ro l^eog i r»_recov«ry 
Oescriptfon: 

This function deterwine* which type of throttle recovery should be 
used. And initializes sone of the variables that will be used. 



static void control engine recovery(void) 
( 

if ((engine status 1= ENGINE RECOVERY MODE) && 

(engine status != ENGINE RECOVERY HCOE COMPLETE}} 

engine_status « ENGINE_RECOVERY_MOOE; 
desired_engine_pct^trq * 0; 
recovery_cancel^ti5er = 0; 
sync_on_timer = 0; 
sync_of f_titner * 0; 

/* reset pedal transition variables */ 
posit ive_pedal_tran$ ■ FALSE; 
positive^pedal^trans ^ FALSE; 
2ero_f lywheel_trq_timer = 0; 
zero"f lywheel"trq_time 3 0; 

if (gos < desired_engine_speed} 
desired_engine"speed = gos; 

/* set initial starting torque limit V /* percent, BIN 8 */ 
if ((actual_engine_pct_trq > needed_percent_for_zero_f lywheel_trq) && 
(pct_demand_at_cur~sp > 5)} 
torque^limit = ((unsigned int}(actual_engine_pct_trq))«8; /* percent, BIN 8 V 
else 

torque limit = ((itfisigned int}( needed j>ercent for zero flywheel trq}}«8; /* percent, BIN 8 V 
> " 

if ((destination_gear > ACTIVE_RECOVERY_GEAR} && 
(pet demand at cur sp < 5} && 
((shift type « COAST OOWH^SHIFT} || 
(shift type == UPSHIFT}}} * 

C 

control engine recovery coast ing(}; 

> 

else 
i 

control engine recovery normaU}; 

> 

#pragma EJECT 
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